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1.  INTRODUCTION 


Terrain  following  systems  evolved  in  the  late  1950s,  after  very 
effective  defenses  against  high-altitude  aircraft  had  developed. 

].ow-alt itude  high  speed  flight  became  the  best  means  for  air  aircraft 
to  evade  detection  and  destruction  by  enemy  defenses.  Many  mode itl 
military  aircraft  (fighters,  bombers,  and  transports)  now  have 
terrain  following  systems.  The  F-lll,  B-52,  and  the  C-5A  are  examples 
of  these.  Future  aircraft,  such  as  the  B-l,  missiles,  and  possibly 
remotely  piloted  vehicles  (RPVs)  will  have  terrain  following  systems. 

It  is  also  possible  that  commercial  aircraft  may  use  similar  techniques 
for  landing  approaches  in  the  future.  Thus,  the  terrain  following 
problem  has  become  important  for  many  types  of  aircraft. 

1.1  The  Basic  Terrain  Following  Troblem 


The  basic  terrain  following  problem  is  to  determine  the  proper 
commands  to  the  control  system  in  order  to  achieve  a flight  path 
that  minimizes  the  probability  of  destruction  of  the  aircraft.  The 
destruction  can  result  either  from  enemy  defenses  or  from  impact  on 
the  terrain.  TIM s definition  presents  a very  complex  problem  that 
depends  directly  on  the  enemy  defenses  and  on  how  well  a particular 
terrain  following  scheme  is  actually  implemented.  The  problem  is 
further  complicated  by  acceleration  and  flight-path  angle  constraints 
that  may  be  imposed  upon  the  aircraft.  Additionally,  some  terrain 
following  systems  can  lie  operated  either  in  an  automatic  mode  or 


in  a manual  mode.  During  the  manual  mode,  the  pilot  provides 
command  inputs  to  the  control  system  after  viewing  a display  gener- 
ated by  the  terrain  following  system.  The  immense  complexity  of  the 


basic  problem  prevents  its  direct  overall  solution;  the  problem 
requires  division  into  subproblems  that  can  be  solved  with  the  avail- 
able mathematical  tools  and  technology.  Accordingly,  only  a major  sub- 
problem of  the  basic  problem  is  treated  here  and  will  be  defined 
precisely  after  some  general  background  information  is  discussed. 

1.2  Previous  Terrain  Following  Systems 

In  the  literature,  a wide  variety  of  major  topics  concerning 
terrain  following  has  been  covered.  These  topics  include  performance 
measures,  probability  of  kill,  probability  of  impact  on  the  terrain, 
displ  ays,  Inman  factors,  terrain  classification,  flight  test  data,  sim- 
ulation data,  turbulence  effects,  and  radar  characteristics.  The 
reader  may  consult  Reference  4 for  a more  detailed  summary  and  a 
bibliography  that  cover  these  diverse  topics. 

The  first -generation  terrain  following  systems  are  basically 
aircraft  flight -path -angle  controllers  [3,  4,  16].  These  angle  con- 
trollers compute  a desired  flight-path  angle  based  on  the  relative 
locations  of  critical  terrain  features . Deviations  from  the  desired 
flight-path  angle  create  pitch  commands  to  the  aircraft  flight- 
control  system. 

The  second-generation  terrain  followers  control  the  path  of  the 
vehicle  more  directly  [2,  4,  11,  23];  the  pitch  commands  are  generated 
to  produce  specific  types  of  paths.  In  order  to  obtain  lower  paths, 
some  systems  use  segments  of  terrain  data,  rather  than  only  critical 
terrain  points.  Path  control  results  in  a natural  division  of  the 
problem  into  the  path-determination  and  the  tracking  subproblems. 

'!uch  of  the  early  development  was  devoted  merely  to  obtaining 


3 


systems  tlint  ix?r formed  in  a reasonable  fashion.  Later,  attempts  were 
tisklo  to  improve  |>erformance  of  the  various  subsystems.  One  example 
of  subsystem  improvement  is  the  optimal  tracker  developed  by  General 
I'.lectric  Company  (25,  24,  25].  In  another,  Greaves  [11]  optimized 
j both  the  tracker  and  the  path-determination  scheme,  but  as  two 

| separate  subproblems.  To  date,  the  latter  has  come  closest  to 

j optimizing  the  overall  system.  There  are  two  major  similarities 

i 

J between  the  work  bv  Greaves  and  that  reported  here:  both  schemes 

I 

are  intended  as  feasible  real-time  controllers,  and  both  formulate 
the  path  optimization  as  a quadratic  programming  problem  with  linear 
; inequality  constraints.  The  primary  differences  are  in  the  approach 

to  optimality,  the  path  data  processing  method,  and  the  implementation 
of  tlie  tracking  system.  The  various  types  of  systems  are  discussed 
' in  more  detail  in  Cliapter  2,  where  appropriate  terms  are  defined. 

| As  indicated  previously,  the  basic  problem  is  too  complex  for 

i 

overall  optimization  with  present  theory  and  techniques.  The  dynamics 
| of  the  aircraft  are  nonlinear  and  the  addition  of  the  many  constraints 

\ makes  the  mathematical  problem  untractable.  The  two  major  contribu- 

tions of  this  dissertation  are  the  precise  definition  of  a mathematical 
! . optimization  problem  that  encompasses  a major  portion  of  the  terrain 

f 

: following  problem,  and  the  parametric  study  of  the  solutions  of  that 

i problem  with  all  of  its  constraints.  Each  solution  of  the  problem  is 

a smooth  reference  path  that  follows  the  terrain  as  closely  as  possible 

| and  is  a path  that  an  aircraft  can  follow  very  well.  The  simplifying 

{ 

> ’ assumptions  required  to  make  the  problem  tractable  are  deemed  to  be 

more  consistent  with  practical  limitations  than  those  of  previous 


approaches.  For  example,  there  is  no  assumption  of  constant  horizontal 
velocity;  neither  is  there  an  attempt  to  make  the  aircraft  follow  a 
path  that  it  cannot  reasonably  be  expected  to  follow.  The  set  of 
allowable  controls  does  not  permit  discontinuous  accelerations  that 
defy  implementation,  but  provides  both  acceleration  and  acceleration- 
rate  limits. 

1.3  The  Information  Processing  Problem 

The  method  of  subdivision  of  the  basic  problem  into  subproblems 
affects  the  performance  of  the  resulting  terrain  following  system,  as 
will  be  indicated  in  the  following  discussion.  The  scope  of  the  prob- 
lem will  be  first  narrowed  to  a much  more  manageable  extent  by  four 
basic  assumptions: 

1)  A reliable  set  of  discrete  terrain  data  points  is  available, 

2)  The  motion  of  the  aircraft  is  restricted  to  a vertical  plane 
so  that  only  longitudinal  motion  is  considered, 

3)  A priori  knowledge  of  enemy  defense  systems  is  not  available, 
and 

4)  The  automatic  mode,  with  no  pilot  in  the  control  loop,  is  to 
be  used. 

These  assumptions,  which  will  be  discussed  in  more  detail  below,  limit 
the  problem  to  the  following  "information  processing  problem’’:  given 

a set  of  terrain  data  points,  determine  the  input  commands  to  the  longi 
tudinal  control  system  of  tlie  aircraft  such  that  the  resulting  aircraft 
path  is  as  low  as  possible,  within  the  following  constraints: 

1)  The  flight  path  is  not  lower  than  a specified  minimun- 
clearance  distance  above  the  terrain  points, 


2)  Specified  normal  acceleration  limits  are  not  exceeded  by  the 
aircraft , and 

3)  Flight -path  angle,  or  slope,  limits  (if  specified)  are  not 
exceeded . 

The  usual  source  of  terrain  information  in  a system  is  a forward- 
looking  radar.  Conceivably,  other  sources,  such  as  satellites  and 
, accurate  terrain  maps,  can  be  used  also.  The  effects  of  radar 
"shadowing”,  which  occurs  because  the  radar  cannot  see  the  back  sides 
of  hills,  are  not  considered  directly  in  this  study.  .Any  terrain- 
following  system  tliat  uses  a forward-looking  radar  suffers  from  this 
sane  handicap  --in  any  case,  whatever  data  are  available  should  be 
processed  in  the  best  manner. 

The  term  "terrain  avoidance"  has  been  applied  consistently  to 

systems  that  involve  lateral  motion  of  the  aircraft,  to  enable  the 

vehicle  to  fly  around  high  peaks  rather  than  over  them.  The  term 

"terrain  following"  has  usually  been  restricted  to  longitudinal - 

motion  systems.  Only  terrain  following  is  studied  here,  although 

♦ 

most  of  the  concepts  could  certainly  be  extended  to  terrain-avoidance 
systems. 

For  general  usage,  it  is  reasonable  to  assume  that  a terrain- 
following system  should  be  able  to  operate  effectively  without  any 
knowledge  of  the  enemy  defenses.  This  requires  a choice  of  performance 
measure  that  is  insensitive  to  the  defensive  configuration.  The 
natural  choice  for  such  a performance  measure  is  to  require  the 
vehicle  to  fly  as  low  as  possible  as  often  as  possible  --  or  in  other 
words,  each  clearance  height  sample  should  be  weighted  equally. 
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Modifications  to  this  procedure  are  easily  possible,  especially  if 
good  rationale  for  weighting  some  regions  more  lieavily  than  others  is 
known.  If  some  a priori  knowledge  of  the  defense  structure  is  known, 

. certainly  the  heavily  defended  regions  could  be  given  higher  per- 
formance weighting  coefficients.  However,  these  ideas  will  not  be 
pursued  further  in  this  thesis. 

The  uniform  global  approach  to  closeness  (treating  staple  points 
equally)  is  at  variance  with  the  assumptions  made  by  Greaves  [11]. 
lie  assumes  that  the  highest  point  of  the  terrain  segment  being  optimized 
is  the  most  critical.  Furthermore,  he  does  not  inpose  a non-zero 
minimal-clearance  distance  constraint,  although  he  might  easily  do  so 
with  his  method;  apparently,  pure  vertical  translation  of  his  optimal 
path  would  be  required  to  provide  a safety  clearance. 

The  automatic  mode  is  considered  more  important  for  low-altitude 
high-speed  flight  because  pilot  reaction  times  can  adversely  affect 
tlvc  system  performance.  This  does  not  iaply  that  the  automatic  mode 
would  be  used  rally  for  high-speed  flight,  but  high-speed  does  provide 
the  most  severe  test  of  a terrain-following  system. 

1,4  The  Specific  Approach 

Within  the  framework  of  the  information  processing  problem,  the 
further  subdivision  of  problems  for  the  proposed  system  can  now  be 
stated : 

1)  Construct  a terrain  representation  curve, 

2)  Determine  a minimum-clearance  curve, 

3)  Optimize  a path  subject  to 

a)  the  constraint  that  the  path  is  above  the  mininum- 


clearance  curve 
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b)  acceleration  constraints,  and 

c)  flight -path  slope  constraints,  and 

4)  Determine  comnand  signals  to  the  aircraft  control  system  based 
on  the  optimal  flight  path. 

The  major  subproblem  is  the  determination  of  a path  for  the  aircraft 
that  satisfies  all  of  the  constraints  and  lies  as  "close"  as  possible 
to  the  terrain.  Since  the  nonlinear  aircraft  equations  of  motion  are 
too  cunbersane  for  efficient  computation,  a very  single  path  model  is 
chosen  into  which  the  specified  constraints  can  be  directly  incorpor- 
ated. The  solution  of  the  problem  with  the  simplified  model  is  a 
reference  flight  path  that  the  aircraft  can  essentially  follow.  There- 
fore, the  tracking  problem  becomes  relatively  simple. 

The  minimun- clearance  constraint  is  obviously  a safety  considera- 
tion. A terrain  curve  is  desired,  rather  than  just  discrete  points, 
so  that  the  effects  of  minimum  clearance  distance  can  be  investigated 
in  detail.  Most  systems  merely  translate  the  terrain  curve  upward  by 
the  specified  reference-clearance  distance  to  obtain  a clearance  path. 
But,  if  tlie  slopes  of  the  terrain  are  large,  some  points  of  the 
resulting  curve  will  be  closer  to  the  nearest  terrain  curve  points  than 
the  reference-clearance  distance,  as  illustrated  in  Figure  2-1  where 

the  reference -clearance  distance  is  c . . The  terms  used  in  the 

nun 

figure  arc  defined  in  Section  2.1.3,  while  the  clearance  effects  are 
investigated  in  Chapter  5,  along  with  the  fitting  of  cubic  splines 
through  data  points. 

The  acceleration  and  flight -path-slope  constraints  are  frequently 
imposed  for  pilot  comfort  and  performance,  although  they  could  also  be 
due  to  aircraft  structural  or  performance  limitations. 
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1.5  Mathematical  Conplexiti.es  of  the  Optimization  Problem 

The  inclusion  of  the  clearance,  slope,  and  acceleration  con* 
straints  in  the  mathematical  optimization  problem  creates  a very  diffi- 
cult problem.  Due  to  the  clearance  and  slope  constraints,  the  resulting 
optimal  control  problem  becomes  one  with  state  variable  inequality  con- 
straints (SVICs).  There  has  been  limited  success  with  general  optimi- 
zation algorithms  that  handle  SVICs.  Methods  that  handle  these 
constraints  directly  require  a priori  assumptions  of  when  and  how  many 
times  the  constraints  are  "active"  (satisfied  by  an  equality).  The 
method  of  Denham  and  Bryson  [10]  and  that  of  Hennig  [15]  are  examples 
of  these.  For  the  terrain- following  problem  in  which  many  contacts 
with  the  constraint  boundaries  are  likely,  the  number  and  locations 
of  the  contacts  are  extremely  difficult  to  predict  in  advance.  It 
very  nearly  requires  guessing  the  complete  solution  in  advance. 

Jacobson  and  Lele  [15]  have  attempted  to  circunvent  these 
difficulties  by  converting  from  state  inequality  constraints  to  slack 
variables.  For  the  same  reason,  Martens son  [20]  converts  the  state 
inequality  constraints  into  control  variable  constraints,  which  can  be 
treated  more  easily.  The  slack  variable  approach  has  inherent  computa- 
tional problems,  while  Martens son's  conversion,  for  this  particular 
problem,  leads  to  incompatible  control  constraint  equations  (there  is 
no  feasible  control  at  times).  Other  special  techniques,  such  as 
decomposition  into  subarcs  [7],  have  been  attenpted  by  other  authors, 
but  they  are  limited  to  special  types  of  problems. 

The  greatest  success  with  SVICs  has  been  in  treating  them  indirectly 
with  penalty  function  methods  [5,  19].  This  was  the  first  approach 


considered.  It  was  successful,  but  it  required  very  large  confuting 
times.  The  details  are  reviewed  in  Section  6.1.  The  second  approach 
was  much  more  effective.  In  it  the  optimization  problem  is  formulated 
first  as  an  optimal  control  problem  with  differential  state  equations, 
continuous  controls,  and  an  integral  performance  measure.  A cubic - 
spline  trajectory  model  reduces  the  problem  to  a finite  dimensional 
optimization,  without  sacrificing  any  of  the  essential  character  of 
the  aircraft  flight  path.  Then,  the  state  equations  are  written  as 
linear  difference  equations,  and  the  control  is  a set  of  discrete 
values.  These  results  simplify  the  computations;  however,  a still 
greater  simplification  is  produced  by  replacing  the  integral  perfor- 
mance measure  by  a discrete  performance  measure  which  is  evaluated 
by  sanpling  the  path  at  intervals.  These  procedures  which  discretize 
with  respect  to  range  result  in  either  a quadratic  or  linear  programing 
problem.  Both  linear  and  quadratic  programming  algorithms  treat  the 
inequality  constraints  directly  and  offer  large  savings  in  conputational 
time.  Furthermore,  good  linear  and  quadratic  programming  algorithms 
are  readily  available  [14,  27,  23]. 

1.6  Overview 

The  second  chapter  defines  some  terrain-following  terminology  and 
nunwirizes  the  basis  of  existing  types  of  terrain-following  systems. 
(Raptor  .i  contains  the  formulation  of  the  optimization  problem  that  if 
the  essence  of  the  optimal -path  following  scheme.  The  usual  terrain- 
following system  does  not  have  all  of  the  terrain  dava  available  at 
one  time;  new  data  is  received  periodically  as  the  aircraft  proceeds 
along  the  terrain.  This  process  leads  to  a sequence  of  data  frames 


and  successive  optimizations.  The  framing  process  and  the  parameters 
involved  are  described  and  analyzed  in  Chapter  4.  Chapter  5 contains 
an  analysis  of  fitting  cubic  spline  functions  through  the  terrain  data 
points  to  obtain  a continuous  curve.  The  continuous  curve  is  used 
to  analyze  construction  of  a minimun-clearance  reference  path,  and 
this  path  is  then  compared  to  a translated  terrain  curve.  In  Chapter  6, 
the  solutions  of  the  optimization  problems  are  given  in  parametric 
studies  of  various  framing  structures.  Analysis  of  the  tracking  problem - 
that  of  determining  comnands  to  the  aircraft  flight -control  system  such 
that  it  will  closely  follow  the  optimal  path  --  is  in  Chapter  7. 

Chapter  8 addresses  sane  of  the  considerations  for  real-time  onboard 
implementation  of  the  optimal-path  foilwing  scheme.  Finally,  con- 
clusions arc  drawn  and  rccoranendations  are  made  in  Chapter  9. 
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2.  TERRAIN  FOLLOWING  CONCEPTS 


In  the  past  many  attempts  have  been  made  to  evaluate  terrain- 
following  system  performance  and  to  establish  criteria  that  are 
meaningful  for  more  than  one  particular  system.  The  determination 
of  criteria  is  a very  difficult  problem  considering  the  differences 
that  can  occur  in  terrains,  in  aircraft,  in  defense  systems,  and  in 
the  implementation  of  the  various  systems.  The  intent  here  is  not 
to  discuss  past  evaluations  in  great  detail,  but  to  give  sufficient 
background  in  some  of  the  more  general  criteria  so  that  the  effec- 
tiveness of  the  system  proposed  here  may  be  judged  more  readily. 
Following  some  definitions  of  terminology  used  in  terrain-following 
analysis  and  a brief  discussion  of  performance  criteria,  some  of 
the  concepts  of  previous  terrain  following  systems  are  discussed. 

2.1  Definitions 

The  following  are  definitions  of  terms  that  will  be  used  fre- 
quently throughout  this  thesis. 

2.1.1  Acceleration  Limits.  The  acceleration  limits  for  terrain 
following  usually  are  specified  in  incremental  G's  (1G  » 32.17 
ft/scc“).  Positive  G's  are  measured  upward  and  level  flight  has  a 
zero  G reference  value.  The  incremental  G's  should  not  be  confused 
with  the  normal  load  factor,  which  has  a one  G reference  value 

for  level  flight. 

2.1.2  Clearance  Curve.  The  terms  clearance  curve  and  clearance 

altitude  refer  to  a curve  and  its  points  that  are  a specified 

"mininun-clearance"  distance,  c from  the  terrain  points.  The 

min 

curve  represents  a lower  bound  for  the  aircraft  flight  path.  The 
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clearance  curve  is  distinct  from  the  desired  reference  curve  or 

reference  path  specified  in  other  terrain  following  systems.  That 

reference  curve  does  not  represent  a lower  bound  on  the  aircraft 

flight  path,  but  is  at  a desired  clearance  distance,  cTQft  above  the 

terrain.  Some  excursions  of  the  aircraft  flight  path  below  the 

reference  curve  can  be  expected.  Typically,  points  on  the  reference 

curves  have  been  measured  vertically  above  the  terrain  points.  If 

the  clearance  curve  is  measured  in  this  manner,  it  is  siiqply  a 

vertical  translation  of  the  terrain.  Such  a curve  will  be  referred 

to  as  the  vertical -clearance  curve.  Obviously,  if  the  terrain  slope 

is  large,  the  clearance  distance  to  the  nearest  point  on  the  terrain 

curve  will  be  less  than  c_.  , as  indicated  in  Figure  2*1.  The 
— - nun 


Figure  2-1  Clearance  Curves 
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clearance  to  the  nearest  point  on  the  terrain  curve  will  be  termed 
the  "slant"  clearance  distance,  cslant.  and  is  measured  perpendicular 
to  the  terrain  curve  at  any  point.  For  the  sake  of  analysis,  con- 
tinuous curves  will  be  fitted  through  terrain  and  clearance  path 
points.  This  fitting  process,  as  well  as  the  computation  of  a slant- 

clearance  path  with  c . . « c - , is  described  in  detail  in 

slant  min 

Chapter  5.  Also,  the  differences  in  the  two  types  of  clearance 
paths  are  analyzed  there.  The  general  term  "clearance  curve"  will 
be  used  to  refer  to  the  curve  regardless  of  how  the  clearance  dis- 
tance is  measured. 

2.1.3  Ideal  Path.  A path  that  is  frequently  used  as  an  evaluation 
tool  in  terrain  following  is  the  ideal  path.  Unfortunately,  this  path 
does  not  have  a unique  definition  in  the  literature.  It  has  been 
determined  in  different  ways  by  different  authors,  but  the  cannon 
requirement  for  this  path  is  that  the  performance  constraints  are 
satisfied.  The  constraints  are  on  either  vertical  or  normal 
acceleration,  on  flight-path  slopes,  and  on  minimum-clearance  dis- 
tance. figure  2-2  shows  a typical  ideal  path. 


Figure  2-2  Ideal  Path 


14 


2.1.4  Terrain  Roughness.  Various  measures  of  terrain  roughness 
have  been  proposed.  One  simple  measure  [4,  page  37]  has  been  the  mean 
of  the  terrain  point  heights,  where  each  sample  point  height,  TR,  is 
measured  from  the  zero  reference  level  — that  of  the  lowest  terrain 
point  in  the  set. 


TMJAN  * J Tn 


This  measure  conveys  very  limited  information  about  the  terrain;  a 
more  descriptive  measure  of  roughness  is  the  standard  deviation  of  the 
terrain  segment  based  on  N sample  points  from  the  terrain. 

«T  ' v/j  j,  <*„  -W2  t2'Z> 

Although  the  decision  is  somewhat  arbitrary  the  following  ranges  are 
adopted  here  to  define  roughness  as  a function  of 


Staooth 


0 to  200  ft. 


Moderate  --  200  to  500  ft. 


Rough 


over  500  ft . 


These  ranges  are  in  general  agreement  with  current  terrain  analyses. 
2.1.5  Path  Curvature  and  Kink.  The  term  "curvature",  in  this 

thesis,  is  defined  as  the  second  derivative  of  the  path  height 
with  respect  to  horizontal  range.  This  definition  differs  from 
that  for  the  usual  mathematic  curvature,  which  is  identically  equal 
to  the  last  term  of  term  of  F,q.  (2-3).  Here  the  curvature 
of  a flight  path  is  related  to  the  aircraft  speed  along  the  path 
and  to  the  acceleration  normal  to  the  path,  by  the  approximation 


^ 4k-^sec3Y.  4 

dR  IT  v 


/ 


15 


where  the  flight-path  angle  is  y.  The  derivation  of  this  equation  and 
the  following  one  are  in  Appendix  C.  The  approx ijnation  is  exact  only 
when  the  flight  path  is  horizontal,  but  it  is  fairly  accurate  for 
small  flight-path  angles.  The  curvature  is  also  related  to  the 
instantaneous  radius  of  curvature,  rc,  and  the  flight -path  angle  by 
the  equation 

rc  ■ \ sec\  (2-4) 

The  derivative  of  curvature  with  respect  to  Tange  is  defined  as 
the  "kink",  p.  Kink  is  analagous  to  jerk,  j (the  rate  of  change  of 
acceleration  in  the  time  domain).  Kink  is  proportional  to  the  jerk 
and  inversely  proportional  to  the  cube  of  the  velocity. 

<2-!> 

2.1.6  Ride  Hardness.  The  hardness  of  the  ride  is  related  to  the 
acceleration  limits  imposed  upon  the  aircraft.  The  term  is  usually 
qualitative  rather  than  quantitative.  The  larger  the  span  of 
acceleration  allowed  by  the  limits,  the  "harder"  is  the  ride.  To  be 
more  specific,  in  this  thesis,  precise  values  for  the  acceleration 
limits  are  assigned  for  the  various  rides.  The  first  set  of 
incremental -G  limits  is  that  given  for  the  F-lll,  Mark  II  System  [5], 
while  the  second  set  is  for  a hypothetical  missile: 

Set  1 Set  2 

Hard  Ride  -1.0  to  +2.0  G's  -5.0  to  +15.0  G's 
Medium  Ride  -0.5  to  +2.0 
Soft  Ride  -0.25  to  •*■2.0  -1.0  to  + 3.0 
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1 

; 

i 

The  negative  limits  are  generally  moTe  restrictive  because  of  the 
pilot  or  because  of  sene  vehicle  configuration.  The  pilot  is 

* ■, 

physiologically  much  more  adaptable  to  positive  G's  than  to  negative 
G's,  while  sene  jet  engine  inlet  configurations  are  unsuited  to  the 
airflow  patterns  resulting  from  negative  G's. 

2.2  Performance  Criteria  and  Parameters 

Sene  of  the  criteria  frequently  used  for  improving  and  evaluating 
terrain  following  performance,  as  indicated  in  the  Terrain  Following 
Criteria  Handbook  [4]  and  by  Brostrom  [6]  have  been 

1)  Minimization  of  FMS  clearance  altitude  deviation  from  a 
reference  clearance  altitude, 

2)  Attainment  of  level  flight  over  dominant  peaks, 

3)  Minimization  of  RMS  normal  acceleration, 

4)  Reduction  of  the  maxima  clearance  altitude  deviation 
from  the  reference  clearance  curve, 

5)  Reduction  of  the  minimum  and  maxima  vertical  accelera- 
tions and  vertical  velocities,  and 

6)  Subjective  evaluations  of  flight  path  time  histories. 

Most  of  these  are  concerned  with  keeping  the  flight  path  as  low  as 
possible,  but  items  3)  and  S)  are  concerned  with  reduction  of  ride 
hardness  and  maximization  of  flight  range.  Jeffrie  [16]  reconmends 
the  comparison  of  the  flight  path  with  the  ideal  path  rather  than 
the  clearance  curve,  as  in  item  4),  above.  He  shows  statistical 
comparisons  that  indicate  clearance  deviations  became  much  less 
sensitive  to  the  particular  terrain  when  the  ideal  path  is  used  as  a 
reference  rather  than  the  clearance  curve.  This  is  not  surprising, 
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for  the  ideal  path  acts  as  a low-pass  filter  in  filtering  out  the  high 
terrain  frequency  components,  as  shot . by  Weir  [31). 

The  parameters  that  affect  the  performance  of  all  terrain  follow- 
ing systems  are 

a)  Aircraft  forward  velocity, 

b)  Aircraft  normal  acceleration  limits, 

c)  Flight-path  angle, 

d)  Minimum-clearance  distance, 

e)  Terrain  roughness  and  frequency  content,  and 

f)  Defensive  threat  situation. 

A good  terrain  following  system  should  allow  for  some  adjustment  in 
all  of  the  above  parameters,  or  it  will  be  too  specialized. 

2.3  Terrain-Following  Cawnand  Generation 

There  has  been  no  standard  for  classifying  the  various  systems 
that  have  been  developed,  but  one  approach  is  to  classify  them 
either  as  flight -path-angle  controllers  or  as  path  controllers. 

Early  systems  were  path-angle  controllers,  where  the  path  itself  was 
only  indirectly  affected  by  the  direct  control  of  the  aircraft 
attitude.  Later  efforts  developed  controllers  that  analyzed  paths 
directly  before  determining  the  proper  attitude  the  vehicle  should 
have  to  produce  a good  approximation  of  the  desired  path. 

2.3.1  Flight -Path-Angle  Controllers.  The  flight -path-angle  control- 
lers have  been  systems  that  generate  commands  based  on  critical 
features  of  the  terrain.  The  cormands  are  based  either  on  the 
relative  range  or  the  relative  angular  position  of  the  critical 
feature  [3,  4,  16],  and  the  general  configuration  is  indicated  in 
block  diagram  of  Figure  2-3. 
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flight  control* surface 

path  deflection 


Figure  2-3  Flight-Path-Angle  Controller  Schematic 

« 

The  first  type  of  controller  to  be  discussed  below  is  the  sim- 
plest since  it  does  not  require  a forward-looking  radar.  This  type 
uses  only  a radar  altimeter  terrain  sensor.  The  two  remaining 
types  of  angle-controllers  are  designed  for  forward-looking  radar 
systems. 

2 . 3. 1 . 1 Relative  Altitude/Altitude-Rate  Systems.  Typical  missile 
terrain-following  systems  use  terrain  data  which  consist  only  of  the 
vehicle  altitude  relative  to  the  terrain,  h , and  the  time  rate  of 
change  of  that  relative  altitude,  fic.  This  type  of  system  has  very 
little  predictive  capability,  since  the  only  terrain  data  used  is 
for  the  terrain  imnediately  below  the  aircraft.  A block  diagram  of 
this  system  is  shown  in  Figure  2-4.  The  difference  between  the 
relative  altitude,  hc,  and  the  desired  reference  value  represents 
an  error  in  current  position.  The  altitude  rate  data  provide  a 
measure  of  the  relative  angular  difference  between  the  vehicle 
flight  path  and  the  local  terrain  slope.  There  are  a wide  variety 
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Figure  2-4  Relative  Altitude/Altitude-Rate  System 

of  ways  of  combining  these  two  signals  in  the  controller  to  produce 
a comnanded  flight  path  angle.  Typically  an  equation  such  as 
F.q.  (2-6)  is  used. 

Yc  - « ft  ♦ 8 (hc  - cref)  (2-6) 

Frequently,  the  negative  a and  0 gains  are  fixed  and  limiters  bound 
both  the  flight-path  angle  and  surface  deflection  ccntnands.  This 
type  of  system  has  found  application  in  missiles  where  space  and 
weight  limitations  are  severe  and  vehicle  maneuverability  is  high. 

2. 3. 1.2  Scanned -Range  and  Template  Systems . In  the  range-type 
systems,  the  response  to  a terrain  feature  depends  upon  its  relative 
range  from  the  aircraft.  Computational  devices,  such  as  the 
"template"  illustrated  in  Figure  2-5,  are  used  to  compute  command 
signals.  The  template  is  not  a physical  device,  but  is  used  only 
for  mathematical  computation.  The  template  is  fixed  with  respect 
to  the  aircraft  axes  and  is  contained  entirely  within  a specified 
angular  sector  (6j  + 62)  ahead  of  the  aircraft.  The  template  is 
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Figure  2-5  Template  System 

terminated  at  a specified  maximal  range,  Rq,  and  is  truncated  by  a 
ramp  at  the  far  lower  corner.  The  actual  dimensions  of  the  template 
must  be  tailored  for  the  particular  radar  and  aircraft  systems.  The 
shape  of  the  template  is  designed  to  separate  terrain  points  into 
two  groups:  those  that  require  pull-up  commands  to  provide  adequate 
clearance,  and  those  that  still  can  be  cleared  when  push-over 
commands  are  given.  First,  the  set  of  ranges,  R^,  corresponding  to 
terrain  points  inside  the  template  is  considered  for  the  pull-up 
computation. 

rc  • « <«R(Ri-R0)}  + °H(hc  ‘ crefJ  (2’7) 

where  and  are  negative  constant  coefficients,  hc  is  the 
current  clearance  height  above  the  terrain,  and  cfe£  is  the  specified 
reference  clearance  height.  The  maximization  in  Eq.  (2-7)  indicates 
that  the  critical  point  is  the  terrain  point  in  the  template  nearest 
to  the  aircraft.  The  first  term  of  the  equation  provides  for 
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clearance  over  the  critical  point,  while  the  second  tern  compensates 
for  current  altitude  deviations  from  the  reference  clearance  height. 
When  no  terrain  points  lie  inside  the  template,  but  there  are  good 
radar  returns  from  points  outside  the  template,  a pitch-down  comnand 
is  created  from  an  equation  similar  to  Eq.  (2-7).  However,  the 
selection  of  the  most  critical  point  outside  the  template  is  more 
complex  and  may  differ  for  different  systems. 

Both  the  template  system  and  the  relative-angle  system,  described 
below,  use  a "back-up"  computation  for  times  when  good  radar  returns 
are  not  available  from  the  forward-looking  radar,  such  as  when  cresting 
a peak  or  when  flying  over  water.  The  back-up  system  is  usually  an  h-fi 
controller  that  uses  a comnand  of  the  form  in  Eq.  (2-6). 

2. 3. 1.3  Relative- Angle  Systems.  The  relative-angle  systems  have 
had  greater  usage  than  the  relative-range  systems.  The  F-lll,  C-5, 

F-4,  and  B-52  terrain- following  systems  are  all  relative-angle  systems. 
These  systems  react  to  terrain  points  that  lie  in  the  range  interval 
lRmin’Rmax1 * “ illustrated  in  Figure  2-6. 
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The  most  critical  terrain  point  in  the  interval  is  determined,  from 
Bq.  (2-8). 

■ mx  {8i>  (2-8) 

a . i 

where  the  index  i refers  to  points  in  the  range  interval  [1^4^, 

R^].  The  critical  point,  at  (R^,  8^),  determines  the  ca—nded 
flight-path  angle: 

Tc  - « (9  ♦ A,  ♦ ^ *FS)  (2-9) 

where  a is  a constant  coefficient,  6 is  the  aircraft  pitch  angle,  and 
the  F$  shaping  function  is  a function  of  the  range  R^  the  aircraft 
velocity,  and  the  aircraft  acceleration  limits.  The  combination  of 
a and  F&  is  chosen  to  provide  the  proper  "amount"  of  prediction  for 
a particular  system.  The  amount  of  prediction  required  varies 
inversely  with  the  range  and  the  maneuverability  of  the  aircraft. 

2.3.2  Path  Controllers.  Three  types  of  path  controllers  are  dis- 
cussed below.  The  first  vats  developed  by  Cornell  Laboratories 
(Cal span)  [2,4],  and  is  called  the  ADLAT  system.  The  second  is  an 
"optimal"  tracker  system  developed  by  General  Electric  Company  for 
the  Air  Force  Flight  Dynamics  Laboratory  [23,  24,  25].  The  last  is 
one  proposed  by  Greaves  [11] , which  uses  both  an  "optimun"  path 
determination  and  an  "optimum"  tracker  system. 

2. 3. 2.1  ADLAT  System.  The  Advanced  Low  Altitude  Techniques  (ADLAT) 
system  [2]  is  one  of  the  earliest  path  controllers.  It  utilizes 
two  parabolic  path  segments  as  shown  in  Figure  2-7. 


23 


V 


pull-up 
parabolic 
segment ' 


max -acceleration- limit  parabola 
<Sax  G’s) 

/ ' push-over  parabolic 

" i ******  tf'Vi.  G's) 


tangent 

point 


min- acceleration- limit 
parabola  (a^G's) 


Figure  2-7  ADLAT  System  Path 

The  segments  are  pieced  together  so  that  they  are  tangent  at  the 
transition  point.  The  first  segment  is  tangent  to  the  aircraft 
flight  path  and  the  second  is  horizontal  at  the  "dominant"  terrain 
obstacle.  Each  parabola  represents  a constant  acceleration  arc. 

The  ratio  of  the  accelerations  on  the  two  arcs  is  the  same  as  the 
ratio  of  the  two  acceleration  limits.  It  is  possible  for  the  two 
arc  geometry  to  degenerate  into  a geometry-  which  involves  only  a 
single  push-over  arc.  If  the  aircraft  were  fairly  high  with  respect 
to  the  obstacle,  the  order  of  the  arcs  might  be  reversed  from  that 
shown  in  the  figure.  However,  if  the  system  is  operating  properly, 
it  should  neveT  allow  the  aircraft  to  get  into  a position  where  the 
limit  areas  that  are  cross-hatched  in  Figure  2-7  overlap. 

Figure  2-8  illustrates  the  controller  which  is  similar  to  an 


angle  controller  except  the  cormanded  angle  is  extracted  from  a 
stored  set  of  sampled  flight -path  angles  computed  from  the  ADLAT 
parabolic  path  segments.  The  sampled  set  is  updated  periodically. 
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Figure  2-8  ADLAT  Path  Controller 

Compensation  is  also  added  to  the  comnand  signal  to  account  for  lags 
in  the  overall  aircraft  control  system. 

2. 3. 2. 2 Optimal  Tracker  System.  The  system  developed  by  General 
Electric  [23,  24,  25]  uses  a stored  segment  of  terrain  data.  Sane 
preliminary  processing  of  the  terrain  data  is  done  to  produce  a 
clearance  curve  as  indicated  in  Figure  2-9.  The  result  is  a path 
lying  somewhere  between  a vertical-clearance  curve  and  an  ideal 
path.  The  path  is  translated  upward  from  the  terrain  curve  by  the 
distance  cmin,  but  in  addition,  parabolic  segments,  representing 
maximum  pushover  arcs,  are  inserted  in  front  of  the  peaks  by  a 
backward  sweep  of  the  data  in  a special  processor.  In  theory  one 
would  like  to  have  the  actual  ideal  path  produced,  (as  will  be 
described  next  in  the  Greaves  approach) , but  this  involves  a 
much  more  complex  piecing  of  arcs,  as  indicated  in  Figure  2-2. 

The  processed  clearance  path  is  used  in  the  General  Electric  system 
as  a desired  tracking  signal  for  an  optimal  tracker.  The  tracker 
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Figure  2-9  Preprocessed  Clearance  Path 

is  really  only  optimal  in  a limited  sense.  The  aircraft  motion  is 

» modeled  as  a simple  third-order  linear  system.  Optimal  feedback 

! 

| gains  for  the  usual  quadratic  cost  tracking  problem  are  found  by 

4 

| the  methods  cf  optimal  control  using  the  Riccati  equation.  Appro- 

priate correlation  between  the  boundary  conditions  and  cost  coef- 

' ficients  produce  constant  gains  for  the  third  order  model.  The 

I prediction  signal  required  foT  the  solution  of  the  optimal  tracking 

problem  is  obtained  by  a fast -time  backward  integration  of  the 
adjoint  equations.  This  signal  and  the  constant-gain  feedback 
signals  provide  the  input  signal  to  the  aircraft  flight -control 
system,  as  indicated  in  the  block  diagram  of  Figure  2-10.  The 
overall  system,  however,  is  only  optimal  to  the  extent  that  the 
preprocessed  clearance  path  coincides  with  the  ideal  path,  and  . 

insofar  as  the  linear  third-order  system  closely  approximates  the 
non'  inear  aircraft  system. 
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Figure  2-10  Optimal  Tracker  System 

2. 3. 2. 3 Optimum  Processor  -Tracker  System.  The  system  developed  by 
Greaves  [11]  has  both  a path- determination  optimizer  and  an  optimal 
tracker.  The  path  processor  is  a nonlinear  digital  filter  that 
performs  a series  of  operations  on  sets  of  discrete-range  path 
points.  The  filter  starts  with  the  set  of  terrain  points  and  pro- 
duces a set  of  path  points  that  satisfy  specified  clearance  and 
acceleration  constraints  while  remaining  "close"  to  the  terrain 
points. 

A series  of  iterations  is  involved;  for  each  iteration,  an 
operator  "optimally*'  enforces  a particular  type  of  constraint  at 
each  point  of  violation  in  the  current  path  point  set.  After  all 
violations  of  one  type  of  constraint  are  eliminated,  the  next  type 
of  constraint  is  considered.  The  sequence  of  constraints  is  ordered 
so  that  no  new  violation  of  previously  satisfied  constraints  occur. 

The  input  set  of  path  points  for  each  operator,  CL , is  designated 
{h^> , and  the  output  set  is  (y^),  where  i is  the  horizontal  range 
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(YJ  « 0.  (h^  (2-11) 

If  Tj  indicates  the  set  of  points  at  which  violation  of  the  jth 
type  of  constraint  occur,  then  the  0j  operator  solves  a 'local" 

optimization  problem  at  the  highest  point,  h^  in  the  set  f y The 

optimization  problem  is  to  minimize 

JnV  * 7 ^ 

i-n-1 

subject  to  the  j**1  type  of  constraint  and  a clearance  constraint. 

Thus,  the  0j  operator  eliminates  a type  j constraint  violation  at  a 
specific  range  point  by  moving  path  points  upward  to  maintain  the 
clearance  constraint.  The  operator  is  used  repetitively  on  the 
path  point  set,  but  it  only  changes  points  in  the  three-point 
"neighborhood"  of  the  violation  at  any  one  step.  The  details  for 
the  operator  are  described  below. 

The  input  set  used  to  begin  the  procedure  is  the  terrain 
heights,  T^,  plus  any  specified  minimum  clearance,  cm^n . 

Ihi>0  ■ (Ti  ♦ W ‘2-12’ 

Greaves  works  with  zero  minimum  clearance,  but  it  is  trivial  to 
extend  the  procedure  to  non- zero  values.  The  clearance  constraint 
that  the  final  set  of  points  must  satisfy  is 

.^i  + Snin  <2-13> 

and  is  maintained  during  each  iteration  step  by  the  "non- lowering" 
requirement : 

Vi  I hj  (2-14) 
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The  first  operator.  Op  enforces  the  minium- acceleration 
constraint : 

’2  Vn  iVlA*  Vl  '2‘1S> 

where  t is  the  tine  interval  required  to  traverse  the  horizontal 
interval  between  terrain  points  (with  the  horizontal  speed  asstmed 
to  be  constant).  This  constraint  essentially  considers  the 
acceleration  at  the  central  point  "n"  to  be  equal  to  the  constant 
acceleration  on  a parabolic  path  through  three  points. 

V » h <Vi  - a*  * Vi>  <2-“> 

The  0^  operator  solves  a local  optimization  problem  at  the  highest 
point,  hn,  in  Tp  The  optimization  problem  is  to  minimize  Jn  of 
fiq.  (2-10)  subject  to  the  constraints  of  Eqs.  (2-14)  and  (2-15). 

This  operation  is  repeated  on  the  path  set  until  is  empty.  Then 
the  maximm-acceleration  constraint  operator  is  used  to  minimize  Jn 
subject  to  Hq.  (2-14)  and  a maximun-acceleration  limit.  Slopo  and 
jerk  constraint  operators  are  also  considered  by  Greaves,  but  for 
simplicity  they  are  not  discussed  here. 

The  mathematical  results  of  the  optimization  problem  for  opera- 
tor 0^  can  be  interpreted  geometrically,  as  illustrated  in  Figure 
2-11.  A parabola  that  has  a curvature  corresponding  to  the  minium- 
acceleration  limit  is  used  as  a violation  indicator.  The  original 
points  are  the  h^  and  the  processed  points  are  the  y^.  In  Case  1, 
both  adjacent  points  lie  below  (or  on)  the  constraint  parabola 
when  the  vertex  of  the  parabola  is  located  at  the  point  of  violation. 
The  minimum  of  Fq.  (2-16)  occurs  when  the  two  adjacent  points  are 
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Figure  2-11  Minimum-Acceleration  Constraint  Enforcement 

raised  to  equal  levels  on  the  parabola.  If  one  of  the  adjacent 
points  lies  above  the  initial  parabola  location,  as  in  Case  2,  the 
parabola  is  repositioned  to  pass  through  the  highest  adjacent  point, 
as  well  as  the  violation  point.  The  solution  is  then  obtained  when 
the  remaining  point  is  raised  to  the  parabola. 

The  complete  iterative  process  is  illustrated  in  Figure  2-12. 

The  original  terrain  data  points  are  shown,  followed  by  the  sets  of 
path  points  that  result  from  the  enforcement  of  each  type  of  acceler- 
ation constraint.  The  points  are  indicated  by  nunbers,  with  the 
letter  subscripts  indicating  the  order  of  the  step  which  resulted  in 
its  final  placement.  For  example,  step  "a"  is  the  first  step  and 
results  in  the  adjustment  of  points  6 and  8,  while  step  "b" 
repositions  only  point  5.  The  curves  shown  are  orientation  refer- 
ences only;  the  filtering  process  works  only  with  the  discrete  points. 

Greaves  admits  that  it  is  difficult  to  determine  the  overall 
sense  of  optimality  in  his  path  processor,  since  a lengthly  series 
of  local  optimization  problems  are  performed.  The  sequence  of 
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Figure  2-12  Digital  Filtering  Process 

optimizations  is  equivalent  to  minimizing  a "global"  performance 
measure  of  the  form 

N . 

1 - I [«.  (y.  - h.)  (y.  - h.)4]  (2-17) 

Unfortunately  the  weighting  coefficients,  wj,  are  not  known  prior 
to  the  optimization,  and  they  depend  upon  the  particular  terrain 
data  used. 

Although  Greaves'  procedure  is  closer  than  any  predecessors 
to  the  overall  objective  of  creating  the  best  path  for  the  vehicle 
to  follow,  it  still  suffers  conceptually  from  two  disadvantages: 
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1)  the  sense  of  overall  optimality  is  obscure,  and  2)  because  of  the 
simplified  (three  point)  treatment  of  the  acceleration  constraints, 
a smooth  path  through  the  final  data  points  may  not  satisfy  the  normal 
acceleration  constraints  between  sample  points.  Ihis  latter  assertion 
is  illustrated  in  Figure  2-13,  where  acceleration  can  be  related 
directly  to  the  path  curvature.  The  data  points  shown  are  a subset 


Figure  2-13  Digitally  Filtered  Data 
of  those  from  the  final  result  in  Figure  2-12.  The  points  satisfy 
the  acceleration  constraints  when  considered  three  at  a time;  however, 
if  a smooth  curve  is  fitted  through  all  four  points,  there  must  be 
some  transition  from  maximum  curvature  to  mininun  curvature.  But 
that  type  of  transition  path  must  violate  the  corresponding  curvature 
limits  somewhere  between  points  10  and  11  in  the  figure. 

The  optimal  tracker  system  for  the  digitally  filtered  path  is 
similar  to  the  General  Electric  tracking  system,  even  though  the 
path  processors  are  considerably  different  in  the  two  systems.  The 
system  diagram  is  basically  the  same  as  that  shown  in  Figure  2-10 
for  the  General  Electric  system.  GTeaves'  system  does  use  a 
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fourth-order  linear  system  model  for  the  tracker,  rather  than  a 
third-order  model.  The  fourth-order  model  is  a better  approximation 
for  a nonlinear  aircraft  system,  but  nevertheless,  the  corresponding 
optimal  tracker  system  is  still  only  optimal  in  an  approximate 
sense,  because  it  uses  a linear  model. 

Hie  optimal-spline-path  following  system  described  in  the  follow- 
ing chapters  attempts  a simpler,  more  practical  coupling  of  the  path 
determination  and  tracking  problems.  The  computed  paths  will  be 
sanother  than  the  processed  paths  of  the  system  described  above 
and  have  a more  practical  curvature  profile. 


3.  MODEL  AND  OPTIMIZATION  PROBLEM  FORMULATIONS 

This  chapter  formulates  an  optimization  problem  that  incorporates 
all  of  the  essential  ingredients  for  terrain  following  in  a very  simple 
way.  The  first  step  is  to  construct  a simple  trajectory  model  for  the 
aircraft  motion.  This  model  will  be  used  in  an  optimal  control  problem 
that  strives  to  keep  the  aircraft  as  "close"  to  the  terrain  as  possible 
without  violating  clearance,  acceleration  and  slope  constraints.  Ini- 
tially, the  problem  is  considered  in  the  most  natural  space,  the  space 
of  continuous  functions.  Then,  to  provide  computational  simplicity, 
the  problem  is  discretized.  The  discretization  is  accomplished  using 
splines,  which  retain  the  essential  characteristics  of  continuous 
functions  even  though  they  are  defined  by  discrete  values.  This  proce- 
dure maintains  a close  relationship  between  the  mathematical  problem 
.and  the  problem  of  controlling  aircraft  motion.  After  the  discrete 
equations  of  motion  are  developed,  the  performance  measure  is  dis- 
cretized also,  by  sampling.  The  resulting  optimal  control  problem 
is  either  a quadratic  or  linear  programming  problem.  The  quadratic 
programing  problem  can  be  solved  by  algorithms  that  treat  it  directly, 
or  it  can  be  converted  into  the  linear  "Complementary  Problem"  prior 
to  the  application  of  an  algorithm.  Any  of  the  programing  problems 
can  be  solved  much  more  rapidly  than  the  original  optimal  control 
problem. 

3.1  The  Trajectory  Model 

The  trajectory  model  that  is  used  here  is  a triple  integrator 
system  defined  in  the  range  domain,  rather  than  in  the  time  domain. 

The  range  domain  is  ideal  for  terrain  following  because  that  is  the 
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natural  domain  of  the  terrain.  In  the  range  domain,  one  does  not 
need  to  consider  the  fluctuations  in  the  tine-rate  of  notion  over  the 
terrain  due  to  aircraft  velocity  changes.  The  trajectory  equations 
are 


(3-1) 

(3-2) 

(3-3) 

for  each  range  R in  the  interval  r • [Rq,R^] , where  h is  the  height 
on  the  path,  s is  the  slope,  k is  the  curvature,  and  p is  the  "kink". 
The  variables  h,  s,  and  k are  continuous,  while  p is  piecewise  con- 
tinuous. The  curvature  is  analgous  to  acceleration  and  the  kink  is 
analagous  to  jerk  (the  derivative  of  acceleration  with  respect  to 
time) . To  make  the  model  paths  correspond  well  to  aircraft  trajec- 
tories, limits  on  both  the  curvature  and  the  kink  are  considered  in 
the  following  problems. 

7>.2  The  Optimal  Control  Problem 

The  trajectory  model  will  be  incorporated  into  the  optimal 
control  problem.  To  solve  the  dilema  of  how  to  define  closeness  to 
the  terrain,  a general  performance  measure  is  studied.  It  is  con- 
structed in  terms  of  the  excess  clearance  variable 

e 3 h - c (3-4) 


The  choice  of  coefficients  Q,  L,  and  M determine  whether  this  perfor- 
mance measure  is  quadratic  (M-0) , linear  (Q  - M'D) , nin-max  (Q  » L»0) , 
or  a combination  of  these. 

The  optimal  control  problem  is  to  determine  the  curvature  function 
k that  minimizes  J subject  to  the  differential  constraints  of  Eqs. 

(3-1)  to  (3-3)  with  specified  initial  conditions  hg,  Sg,  kg,  and  subject 
to  the  following  inequality  constraints , for  ail  Rer 

e > 0 (3-6) 


s • < s < s 

min  - — max 


'Snin  — ^ — ^Snax 


p . < p < p (3-£ 

1 min  — v - pmax  v 

The  limits  on  the  curvature  ar^  determined  from  the  normal  accel- 
eration limits  and  aircraft  speed  by  the  approximation  of  Eq.  (2-3) 


a,1lim 


(3-10) 


This  approximation  is  accurate  only  as  long  as  the  path  slope  is 
small.  However,  the  approximation  is  good  because  the  limits  tend 
to  be  encountered  at  the  tops  of  peaks  and  the  bottoms  of  valleys 
where  the  flight  path  is  nearly  horizontal.  The  kink  limits  are 
related  to  jerk  limits,  which  usually  are  not  specified  for  an  air- 
craft. However,  jerk  affects  the  ride  comfort  for  a pilot  and  the 
performance  of  the  tracking  system  that  attempts  to  follow  the 
reference  path.  Therefore,  bounds  on  the  jerk,  or  kink,  are  desirable 
and  are  discussed  further  in  Chapter  4. 
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3.3  Discrete  Equations  of  Motion 

The  integration  of  differential  equations  on  a digital  computer 
is  a tine  consisting  process.  Also,  the  search  of  function  space  for 
an  optimal  control  can  be  very  slow  compared  to  discrete  parameter 
optimization.  Therefore,  the  use  of  discrete  range  equations  of  motion 
and  a discrete  range  control  set  greatly  simplifies  the  optimal 
computations  for  this  problem. 

Spline  curves  are  very  useful  in  fitting  smooth  curves  through 
data  points  [1] . The  cubic  spline  is  composed  of  cubic  polynomial 
segments  pieced  together  to  provide  continuous  first  and  second  deriva- 
tives at  the  junctions.  The  path  model  is  to  be  represented  by  a 
cubic  spline.  Thus,  the  path  slope  is  a quadratic  spline,  the  curva- 
ture is  a linear  spline,  and  the  kink  is  a piecewise  constant  function. 
The  curvature  is  to  be  considered  the  control  variable  and  is  illus- 
trated in  Figure  3-1.  A set  of  range  values,  R^,  is  arbitrarily  chosen 
for  the  spline  "knots"  (segment  junctions) . The  interval  between  knots 
need  not  be  equal,  although  it  is  often  convenient  to  use  uniform 
spacing. 


Figure  3-1  Curvature  Spline 


The  curvature  values  at  the  knots,  along  with  the  Rj,  carpletely 
specify  the  curvature  function  on  the  interval  r.  Furthermore,  the 
kink  can  also  be  specified  in  terms  of  the  knot  values  and  the  interval 


lengths,  Ai  - Ri  - Ri_1, 


ki*l  * ki 


for  Rc(R.,Ri+1) 


(3-11) 


Obviously,  the  kink  is  equal  to  the  slope  of  each  straight  line  seg- 
ment in  Figure  3-1.  With  the  addition  of  initial  values  hp  and  Sq, 
the  path  height  and  slope  can  be  written  as  difference  equations  that 
incorporate  the  spline  continuity  requirements. 


si  - si-l  * 7 * ki-l> 
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The  corresponding  discrete  kink  equation  is 
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Note  that  each  of  these  last  throe  equations  defines  an  affine 
function  of  the  set  of  k^  curvature  values.  If  the  equations  are  a 
applied  recursively,  each  of  the  values  h^,  s^,  and  p^  can  be  written 
in  terms  of  the  initial  conditions  and  the  k^  values,  for  i*l,  2,  ..., 
N.  The  vector-matrix  form  is 


h - Ek  ♦ f 


(3-15) 


s * Sk  + b 


p =*  Pk  + d 


(3-16) 

(3-17) 


38 


where  h,  s , k,  p,  f , b,  and  d are  N-dimensional  vectors  and  E,  S,  and 
P are  NxN  matrices  that  have  a triangular  font.  The  elements  of  E, 

S,  P,  f , b,  and  d are  confuted  recursively  from  the  interval  lengths 
A^  and  the  initial  conditions  hg,  sQ,  and  kfl.  Hie  equations  for  these 
elements  are  developed  in  Appendix  A.  It  is  possible  to  sample  the 
variables  at  points  other  than  the  knots,  but  this  application  will 
not  be  considered  here.  The  excess -clearance  sample  vector  can  be 
written 


e » h-c  - Ek+f-c 


(3-18) 


where  c is  an  N-vector  of  the  clearance  curve  sanple  values.  The 
inequality  constraints  of  Eqs.  (3-8),  (3-6),  (3-7),  and  (3-9)  can  be 
written  in  a single  inequality 
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wiiere  I is  the  NxN  identity  matrix  and  u is  an  N-vector  of  unit 
elements.  Eq.  (3-19)  enforces  tJie  constraints  only  at  the  N knots, 
but  this  still  implies  satisfaction  of  the  limits  on  curvature  and 
kink  over  the  entire  interval  r,  as  can  be  observed  from  Figure  3-1. 
However,  the  clearance  and  slope  constraints  are  not  necessarily 
satisfied  over  the  intervals  between  knots.  Definite  bounds  on  the 
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amount  of  constraint  violation  can  be  confuted ; equations  for  these 
bounds  are  developed  in  Appendix  H.  The  violations  will  normally 
be  quite  small. 

3.4  Discrete  Performance  Measure 

Invariably,  in  evaluating  terrain  following  performance,  inves- 
tigators resort  to  sampling  the  trajectories  to  evaluate  the  system. 
Thus,  it  is  not  unnatural  to  use  a discrete  range  performance  measure, 
especially  when  using  discrete  range  equations  of  motion.  The  use  of 
the  discrete  measure  also  reduces  the  computation  required.  The  dis- 
crete performance  measure  is  a sampled  version  of  Eq.  (3-5) : 

J ' jj  Vnl  * M 7 •'rf  (3-20) 

An  equivalent  vector-matrix  measure  is  obtained  using  Eq.  (3-18) 
for  e 

J - L’  k ♦ } k’  Qk  ♦ M max  (Ek>  (3-21) 

“ component 

where  L is  an  N-vector  computed  from  the  C^,  Ln,  E,  f and  hc;  Q is 
a symmetric  NxN  matrix  computed  from  the  and  E. 

In  the  early  stages  of  this  study,  penalty  function  approaches 
were  tried  to  enforce  the  clearance  constraint.  This  involved  the 
addition  to  Eq.  (3-20)  of  a term  of  the  form  , which  was 
added  only  for  en<0.  This  approach  resulted  in  a "soft"  constraint 
that  allow  some  violations  of  the  clearance  constraint.  Although  the 
violations  were  reasonably  small,  it  was  not  possible  to  determine 
a priori  a bound  on  the  violations.  When  it  became  apparent  that  the 
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discrete  formulation  resulted  in  a quadratic  programing  problem,  the 
clearance  constraints  could  be  treated  directly  and  the  penalty 
function  approach  was  abandoned. 

3.S  Quadratic  Programing  Problem 

The  quadratic  programming  problem  follows  directly  from  the 
discretized  equations  (3*19)  and  (3*21),  with  a scalar  variable  'W' 
introduced  to  treat  the  min-max  term.  The  problem  is  to  determine 
the  (N+l)  dimensional  K vector 


that  minimizes 


J - L'k  ♦ \ k’Qk  ♦ Mm 
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subject  to 

C*  K<D  (3-2 

where  the  C and  D are  formed  from  the  matrices  of  Eq.  (3-19),  plus 
appropriate  coefficients  for  m if  the  min-max  term  of  Eq.  (3-23)  is 
used  (Mj*0),  The  additional  constraint  set  that  is  added  to  Eq. 
(3-19)  to  produce  Eq.  (3-24)  is  an  upper  bound  on  the  excess 
clearance  at  each  of  the  knots: 


Pk  - un  < f-c 


where  u is  an  N- vector  of  unit  elements.  Any  of  the  constraints 
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that  are  not  needed  for  a particular  aircraft  or  mission  can  be  elimin- 
ated from  the  matrices  to  reduce  the  problem  dimension. 

It  should  be  noted  that  the  above  problem  will  be  a linear  program- 
ming problem  when  the  quadratic  performance  coefficients,  C^,  are  set 
to  zero.  Many  algorithms  are  available  to  solve  the  linear  programming 
problem  [14],  The  above  form  of  the  quadratic  progranming  problem  can 
be  solved  by  two  different  approaches:  there  are  algorithms  that  treat 
the  above  form  directly  [29] , or  the  Lemke  approach  [26]  is  to  convert 
the  quadratic  problem  into  a higher- dimensional  linear  programming 
problem,  called  the  "Complementary  Problem."  If  the  min-max  term  is 
not  used,  so  that  the  quadratic  coefficient  matrix  Q is  positive 
definite,  Shankland's  algorithm  [29]  can  be  used  to  solve  the  quad- 
ratic problem  directly.  The  Complementary  Problem  has  special 
structure  that  is  handled  readily  by  special  linear  progranming  algori- 
thms, such  as  Ravindran's  [26].  The  algorithms  are  discussed  in  more 
detail  in  Chapter  6. 

3.5  The  Complementary  Problem 

The  basic  formulation  from  which  the  Lemke  development  starts 
is  a slightly  different  form  of  the  quadratic  programing  problem. 

It  is  converted  into  a linear  progranming  problem  by  the  use  of 
slack  variables  and  the  Kuhn-Tucker  conditions  of  optimality  [8] . 

The  particular  quadratic  problem  is  to  minimize 

7 = L'x  + ^c'Qx  (3-27) 

subject  to 

Gx  > H (3-28) 


and 


x > 0 


(3-29) 
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Eq.  (3-28)  is  converted  from  an  inequality  constraint  to  an  equality 

* 

by  the  introduction  of  a "u"  slack  variable  vector,  which  is  also 
constrained  to  have  non-negative  components. 


u - G x - H 
u > 0 


(3-30) 

(3-31) 


When  the  Kiihn-Tucker  conditions  [8,  pp  54-S6]  are  applied,  the  result 
is  a system  of  linear  equations  with  some  undetermined  multipliers 
v and  y (these  are  frequently  called  the  dual  variables) . plus  non- 
negativity constraints  on  all  the  variables,  and  an  additional  ortho- 
gonality requirement: 


U,  V,  x,  y i 0 

A 

v'  x ♦ u'  y * 0 

Eq.  (3-32)  can  be  written  in. a more  concise  form  by  grouping  the 
variables  into  two  vectors: 


(3-32) 

(3-33) 

(3-34) 
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(3-35) 
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(3-36) 

c n 

(3-37) 
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(3-38) 

Now  we  consider  the  final  formulation. 
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The  Complementary  Problem  is  to  determine  the  unique  w and  z 
vectors  that  satisfy  Eqs.  (3-39),  (3-40),  and  (3-41). 


w * R z ♦ q 
w,z  >_  - 0 
w'  z * 0 

Eq.  (3-39)  can  also  be  written  in  the  linear  programing  form: 


(3-39) 

(3-40) 

(3-41) 


(3-42) 


The  constraints  of  Eqs.  (3-40)  and  (3-41)  make  it  a special  linear 


programing  problem  in  which  either  each  component  of  z or  the 
corresponding  component  of  w must  be  zero.  Ravindran  used  this  special 
property  for  a modified  "Revised-Simplex"  algorithm  to  solve  this  com- 
plementary problem.  The  non-negativity  requirements  involve  a 
biasing  of  each  of  the  curvature  values  for  the  terrain  following 
problem. 


xi  " ki  ' ^nin  for  i-1,  2,  ....  N (3-43) 

When  the  min-max  variable  is  used,  it  does  not  require  a bias,  as 
it  is  already  positive. 

The  Ravidran  algorithm  can  solve  either  the  linear  or  quadratic 
programing  problem.  This  flexibility  makes  it  useful  for  testing 
the  different  performance  criteria;  thus,  it  is  the  primary  algorithm 
used  in  the  parametric  studies  of  Chapter  6. 
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4.  FRAMING  FOR  DATA  PROCESSING 

It  is  unpractical  to  solve  a single  optimization  problem  for  the 
entire  flight  of  an  aircraft.  The  great  lumber  of  samples  that  would 
be  required  would  produce  an  optimization  problem  of  extremely  high 
dimension.  Furthermore,  all  of  the  required  terrain  data  may  not  be 
available  at  the  beginning  of  the  flight.  The  method  for  handling 
these  problems  is  a framing  procedure.  Frames  of  terrain  data  are 
considered  serially  as  the  aircraft  advances  over  the  terrain,  and 
an  ideal  path  is  produced  for  each  frame  by  solving  an  optimiza- 
tion problem  of  the  type  considered  in  Chapter  3.  The  details  of 
the  framing  procedure  are  described  in  the  following  sections.  To 
reduce  computational  requirements,  it  is  desirable  to  use  the  minimum 
amount  of  data  that  will  still  produce  good  performance.  To  estimate 
the  required  amount  of  data  and  other  framing  parameters,  the  idea 
of  a "characteristic  maneuver"  is  introduced. 

4.1  The  Characteristic  Maneuver 

The  unpredictability  of  many  terrains  makes  the  determination 
of  an  adequate  frame  length  difficult.  The  characteristic  maneuver  is 
developed  here  for  estimating  this  frame  length  in  a fairly  simple 
manner.  A "maximun-expected-ohstacle  height",  H,  is  specified,  and 
then  the  minimum  range  interval  required  to  clear  tlie  obstacle  and 
return  to  level  flight  is  computed.  Any  curvature  and  slope  constraints 
imposed  on  the  flight  path  must  be  considered  in  the  confutation.  For 
simplicity,  only  the  curvature  limits  will  be  considered  here  because 
slope  constraints  are  frequently  not  imposed.  The  geometry  of  the 
characteristic  maneuver  is  illustrated  in  Figure  4-1,  where  the 
symmetric  path  and  curvature  profiles  are  shown. 
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Figure  4-1  Characteristic  Maneuver 


The  parameters  of  the  maneuver  are  &c,  F , nc,  II,  k^^,  and 
The  curvature  limits,  k[nax  and  ktn-r|,  are  computed  from  normal 
acceleration  limits  and  aircraft  speed.  Since  negative  acceleration 
is  usually  limited  to  a smaller  magnitude  than  the  positive  accelera- 
tion, the  length  of  the  pushover  arc,  ncAc>  is  longer  than  the  pullup 
arc  length,  Ac,  while  the  transition  arcs  also  have  a length,  Ac. 

Note  that  the  positive  and  negative  areas  under  the  curvature  profile 
in  the  figure  must  be  equal  for  the  aircraft  to  return  to  level 
flight.  In  the  computations,  the  value  of  n£  will  be  considered  a 
real  nunber  rather  than  an  integer.  The  equations  for  nc,  &c,  and 
Fc  are  developed  by  piecewise  integration  in  Appendix  B. 
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Fc  • Ac  (5  - 4 (4-2) 

nc  • - (4  ♦ i)  (4-3) 

The  parameter  Ac,  called  the  characteristic  interval,  represents 
the  maximum  size  control  interval  that  can  be  used  while  performing 
the  maneuver  in  the  min  mm  frame  length,  Fc<  If  a & is  selected 
that  is  greater  than  Ac  the  pullup  maneuver  will  cause  the  path  to 
rise  higher  than  H before  level  flight  can  be  attained,  or  level  flight 
can  be  achieved  only  at  a range  greater  than  Fc/2.  Values  of  A smaller 
than  &c  can  be  used  to  perform  a similar  maneuver,  but  intermediate 
control  values  between  k^  and  k^  may  be  required  at  some  points. 

To  be  certain  that  the  characteristic  maneuver  can  be  performed  within 
a frame  length  that  is  an  integral  multiple  of  the  control  interval  A, 
one  can  use  the  following  equations: 

T =■  A (6+n)  (4-4) 

whcTe  the  integer  "n"  satisfies 


n 1 nc 


The  characteristic  maneuver  analysis  yields  a good,  simple  estimate 
of  frame  length.  However,  it  is  based  on  the  clearance  of  a single 
obstacle,  and  there  may  be  times  when  multiple  obstacles  of  real 
terrains  may  degrade  the  performance.  There  are  other  framing 
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aspects  which  also  affect  the  performance.  These  will  be  discussed 
in  the  following  sections. 

4.2  Frame  Advance 

The  frame  advance  process  is  illustrated  in  Figure  4-2.  At  one 
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t Frame  ^ 3rd  Frame 
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2nd  Frame  I 
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Figure  4-2  Data  Frame  Overlap 


extreme,  there  is  no  overlap  of  frames;  the  second  frame  begins  where 
the  first  ended,  and  the  frame  advance  is  equal  to  the  frame  length. 
This  reduces  the  number  of  optimizations  to  a minimum,  but  it  is 
largely  an  open  loop  system  as  far  as  terrain  and  clearance  curve 
information  is  concerned.  There  is  no  adjustment  to  the  data  during 
the  full  frame  interval.  If  the  terrain  data  were  perfect,  non-over- 
lapping frames  would  work  well,  but  the  present  state  of  the  art  in 
terrain- following  radars  is  such  that  good  returns  are  not  always 
available.  Returns  are  also  subject  to  the  phenomenon  called  "radar 
shadowing",  in  which  part  of  the  terrain  blocks  the  radar  energy  from 
reaching  portions  of  the  terrain  at  greater  ranges.  From  a practical 
viewpoint,  it  is  desirable  to  update  portions  of  the  terrain  data 
as  new  data  become  available,  before  a full  data  frame  is  completely 
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traversed  by  the  aircraft.  To  allow  maxima  feedback  of  terrain 
information  the  frame  advance  distance  should  approach  zero,  but  the 
frames  must  advance  at  a rate  which  is  at  least  as  great  as  the  air- 
craft speed.  This  establishes  a minima  frame  advance  rate:  however, 
the  frame  computational  time  must  also  be  known  to  compute  the  frame 
advance  distance.  It  is  possible  to  advance  the  frames  more  rapidly 
than  the  aircraft  speed  to  allow  same  idle  time  between  successive 
frame  confutations.  Since  the  confutation  time  for  different  frames 
will  usually  vary,  same  idle  time  should  nominally  be  allowed. 

4.3  Frame  Length 

Although  the  required  frame  length  can  be  estimated  from  the 
characteristic  maneuver  described  previously,  there  are  a few  other 
frame- length  aspects  that  should  be  mentioned.  The  characteristic 
frame  length,  Fc,  is  the  estimate  of  miniman  frame  length,  but  there 
is  also  an  upper  bound  on  the  frame  length  that  is  dictated  by  the 
source  of  terrain  data.  The  amount  of  data  to  be  optimized  in  a single 
frame  must  lie  somewhere  between  these  two  extremes.  To  reduce  the 
confutation  required,  the  frame  length  should  be  chosen  near  the 
cliaracteristic  value.  Furthermore,  the  data  at  the  far  end  of  the  frame 
may  be  less  accurate  than  that  near  the  aircraft,  which  is  another 
reason  that  processing  time  should  not  be  devoted  to  any  "excess" 
information. 

There  can  be  an  interaction  between  frame  length  and  frame  advance 
that  affects  the  predictive  capability  of  the  system.  The  objective 
is  to  keep  the  frame  length  long  enough,  and  the  frame  advance  short 
enough  that  the  predictive  capability  of  the  process  is  sufficient 
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for  the  particular  terrain  that  is  encountered.  This  capability  is 
affected  by  the  following  factors: 

a)  Aircraft  speed , 

b)  Acceleration  limits, 

c)  Slope  limits, 

d)  Kink  limits,  and 

e)  Terrain  roughness  and  frequency  content. 

The  characteristic  frame  length  computation  requires  an  estima- 
tion of  the  maximum  expected-  obstacle  height,  H.  If  the  specific 
terrain  segment  to  be  traversed  is  known,  an  appropriate  height 
can  be  readily  determined  from  the  terrain  data.  However,  in  many 
cases  the  exact  terrain  information  may  not  be  available  in  advance. 

A possible  method  of  estimating  an  H,  in  this  case,  is  to  select 
H - 3o^,  where  oT  is  the  best  estimate  of  the  terrain  standard 
deviation  (the  roughness)  in  the  general  area  of  the  flight. 

4.4  Frame  Junctions 

Since  one  of  the  objectives  of  the  terrain- following  control 
system  considered  here  is  to  provide  a fairly  smooth  conmand  signal 
to  the  aircraft  flight-control  system,  care  must  be  taken  to  minimize 
discontinuities  at  frame  junctions.  Some  of  the  possible  ways  of 
joining  frames  can  be  visualized  by  referring  to  Figure  4-3.  The  paths 
in  the  frame  advance  interval  are  of  primary  interest.  Ideally  the 
computation  of  the  optimal  path  for  Frame  2 would  start  from  point  A, 
the  actual  position  of  the  aircraft  at  range  Rj.  Unfortunately,  the 
computation  of  the  optimal  path  for  Frame  2 must  begin  when  the  aircraft 
is  at  range  Rq,  and  must  be  complete  by  the  time  the  aircraft  reaches 
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so  that  the  commands  are  available  for  the  path  intsdiately  following 
that  position.  Therefore,  computations  for  any  frame  must  be  based 
on  a predicted  position  at  the  beginning  of  that  frame. 

One  possible  way  of  beginning  the  Frame  2 computation  is  to  pre- 
dict the  aircraft's  position  by  same  set  of  prediction  equations, 
based  on  the  aircraft's  position  at  RQ  and  the  cormands  generated 
by  the  optimal  path  of  Frame  1.  This  is  indicated  as  the  point  B in 
Figure  4-3.  The  disadvantage  of  doing  that,  even  though  it  may 
more  accurately  represent  the  true  aircraft  position,  is  that  the 
optimal  paths  of  Frame  1 and  Frame  2 would  be  disjoint. 

A more  reasonable  and  simplier  approach  is  to  use  point  C on 
the  Frame  1 optimal  path  as  the  starting  point  for  the  optimal  path 
of  Frame  2.  In  this  way  the  optimal  path  will  be  continuous  from 
frame  to  frame,  rather  than  disjoint.  Furthermore,  the  slope  and 
curvature  of  the  optimal  path  can  be  made  continuous  by  matching  the 
Frame  2 values  with  those  of  Frame  1.  Then  the  initial  control  point 
is  fixed  rather  than  varied  in  determining  the  optimal  path  for 
each  frame.  This  is  the  procedure  that  is  used  in  the  parametric 
studies  of  Chapter  6. 
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If  the  ccmnand  signals  to  the  aircraft  flight-control  system  are 
based  on  a feedback  controller,  i.e. , a signal  proportional  to  the 
difference  in  the  optimal  path  and  the  actual  aircraft  path,  then 
these  are  continuous  also  because  the  aircraft  values  would  be  con- 
tinuous. A possible  difficulty  would  result  for  a terrain  data 
update  in  which  the  new  terrain  is  significantly  higher  than  the  old. 
This  is  illustrated  in  Figure  4-4,  where  the  initial  point  C for 
Frame  2 lies  below  the  mininun  clearance  path.  This  creates 
difficulties  for  the  programming  algorithms,  as  it  is  likely  that 
there  will  be  no  feasible  solution  that  satisfies  all  of  the  clearance 
constraints.  Quasi- solutions  that  "approximately''  satisfy  the  con- 
straints are  required  in  this  case  and  will  be  discussed  in  Section 
6.2. 
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Range 

Figure  4-4  Infeasible  Solution  at  Frame  Junction 
4.5  Control  Point  Spacing 

The  number  of  control  points  used  per  frame  should  be  large 
enough  to  allow  adequate  control  flexibility.  Fine  spacing  of  the 


control  points  allows  the  greater  flexibility,  but  it  also  places 
stronger  denary  Is  on  the  flight-control  system,  as  the  rate  of  cowand 
signal  change  will  be  greater.  Rirthenaore,  the  number  of  control 
points  and  constraint  points  needed  to  span  the  frame  is  also  greater 
which  in  turn  requires  greater  amount  of  commutation  to  solve  the 
optimization  problem.  While  it  is  convenient  to  use  uniform  control 
point  spacing,  it  may  not  be  necessary,  or  even  possible  for  long 
data  frames,  if  all  computation  is  to  be  done  in  real  time.  The 
spacing  can  be  graduated  so  that  it  is  finely  spaced  in  the  near 
frame  (close  to  the  aircraft)  and  coarsely  spaced  in  the  far  frame, 
as  shorn  in  Figure  4-S.  The  rationale  for  this  is  that  only  gross 
positional  changes  need  to  be  considered  in  the  far  frame  where 
updated  data  will  be  available  for  refinement  in  subsequent  frames. 
The  main  reason  for  the  far  frame  data  is  to  predict  far  enough 
ahead  that  the  aircraft  will  not  fly  into  an  untenable  position, 
from  which  it  cannot  recover.  If  the  spacing  is  too  coarse,  however, 
a loss  of  control  flexibility  will  raise  the  mean  clearance  level 
for  me  flight. 
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The  limits  on  kink  are  inherently  related  to  the  control  interval 
and  the  curvature  limits,  as  indicated  previously  in  Eq.  (3-14),  and 
in  a slightly  different  form  in  the  following  equations. 


^nax"^nin 

Plim 

A 

(4-6) 

pmax 

" Plim 

(4-7) 

pmin 

“ 'Plim 

(4-8) 

f TWo  approaches  to  treating  the  kink  limits  are  available.  The  limits 

| may  be  enforced  directly  in  the  optimization  problem  by  including 

( 

j them  in  the  constraint  set.  Alternatively,  it  may  be  possible  to 

choose  the  control  interval  such  that  the  inherent  kink  limits  are 
j acceptable  for  the  specified  curvature  limits.  Either  of  the  two 

alternatives  mist  be  investigated  in  terms  of  the  optimization 
problem  dimensions,  which  depend  upon  both  the  number  of  sample 
points  and  which  types  of  constraints  are  enforced. 

All  of  the  various  parameters  that  affect  the  framing  process 
are  listed  in  the  following  section,  while  the  parametric  studies 
are  discussed  in  Chapters  6 and  7.  The  studies  include  frame  length, 
control  point  spacing,  computational  times,  and  frame  advance 
rates. 

4.6  Specification  of  Framing  Structure 

The  solution  of  the  optimization  problem  requires  the  speci- 
fication of  many  parameters  and  their  numerical  values.  To 
completely  specify  a framing  structure  the  following  parameters  are 
required: 
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1)  Frame  length, 

2)  Frame  advance  distance, 

3}  Limits  on  path  curvature, 

4)  Minimm- clearance  distance  and  type  of  clearance, 

5)  Number  and  spacing  of  control  points, 

6)  Performance  measure  sample  points, 

7)  Terrain  sample  points, 

8)  Clearance  constraint  sample  points, 

9)  Performance  measure  coefficients, 

10)  Limits  on  path  slope  (optional) , 

11)  Limits  an  kink  (optional) , and 

12)  Slope  constraint  sample  points. 

Note  that  the  acceleration  constraints  need  not  be  specified  directly, 
if  the  path  curvature  is  the  primary  consideration.  For  a specified 
frame  structure,  different  nominal  flight  speeds  can  be  used  if  the 
corresponding  inherent  acceleration  limits  are  acceptable,  as 
determined  by 


alim  ’ klim  Vnom  (4'9) 

The  most  convenient  method  of  sampling  is  to  use  the  same  sample 
interval  for  each  of  the  variables  mentioned  above.  The  numerical 
equations  used  are  simplified  by  this  procedure.  However,  there  may 
be  same  tradeoffs  between  the  complexity  of  the  equations  and  the 
number  of  samples  required,  if  some  of  the  variables  can  be  sampled 
at  slower  rates.  These  tradeoffs  are  heavily  dependent  upon  the 
particular  framing  structures  being  considered  and  are  beyond  the 
scope  of  this  study. 


5.  TERRAIN  AND  CLEARANCES  CURVES 


Although  the  performance  is  measured  and  the  constraints  are 
enforced  only  at  discrete  points,  the  investigation  of  the  clearance 
distance  to  the  nearest  terrain  point  requires  a continuous  curve 
representation  for  the  terrain.  Many  possible  representations  can 
be  chosen;  however  the  one  selected  here  is  a cubic  spline  function. 
One  of  the  reasons  for  choosing  a cubic  spline,  with  continuous 
first  and  second  derivatives,  is  that  this  closely  corresponds  in 
smoothness  to  the  optimal  path  that  will  be  subsequently  determined 
from  the  terrain  curve.  Also,  the  techniques  for  fitting  cubic 
splines  through  data  points  are  well  developed  and  have  been  very 
successful  in  a wide  variety  of  applications  [1] . 

5.1  Cubic  Splines 

A cubic  spline  function  is  a sequence  of  cubic  polynomial  seg- 
ments joined  to  form  a continuous  function  that  has  continuous  first 
and  second  derivatives.  The  general  function  form  is  given  in 
I!q.  (5-1)  and  is  illustrated  in  Figure  5-1. 


Figure  5-1  Cubic  Spline  Function 
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y(x)  - VAi (“i^)  +Bi hfr 2*ci (“^i) 3 **  (5-1) 

where 

*i  $ xi+l  * xi  (S*2) 

The  junction  points,  (x^y^),  are  called  "knots".  Many  different 
approaches  to  fitting  the  cubic  spline  function  to  discrete  data 
have  been  used  [1,22,28,30].  No  single  approach  is  followed  here; 
the  best  features  of  routines  by  various  authors  are  used. 

One  fitting  method  varies  the  positions  of  the  knots  and  fits 
the  curve  close  to  the  data  points  in  a weighted-least-square  sense 
[22].  However,  assuming  the  terrain  data  points  are  the  best 
estimates  for  the  actual  terrain,  the  curve  should  pass  through  the 
data  points.  To  guarantee  this,  the  data  points  are  selected  as 
the  knots.  Then  the  fitting  process  is  merely  the  determination  of 
the  set  of  coefficients  for  each  segment  of  the  curve.  For  n data 
points,  there  is  a set  of  three  coefficients  (A^  Bj,  cp  for  each 
of  the  n-1  segments.  Note  that  there  is  no  requirement  that  the 
intervals  between  data  points,  a.,  are  equal,  even  though  this  is 
often  convenient.  The  continuous  derivatives  of  the  spline  function 
are 

y’Cx)  - ± [A.  ♦ 2 ♦ 3 C.cl^i)2]  (5-3) 

x~x  ♦ 

y"W  - -K  [2  B.  * 6 C.(— ^)]  (5-4) 

a/  1 1 ai 

To  determine  the  coefficients,  continuity  conditions  on  y,y'  and 
y"  are  applied  at  each  of  the  n-2  interior  knot  positions,  using 


i 
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the  relationships:  at  x-x^,  (x-x^)/a^  ■ 0,  and  at  x-x^, 
(x-xi)/ai  - 1. 

For  i«l,2 n-2 


where 


Ai  * *i  * ci  ■ ■ Yi 

(5-5) 

Ai  * 2Bi  * Ki  ‘ V w ■ HiAs.i 

(5-6) 

“i  ♦ Ki  ■ “iV'i.i  - »i\.i 

(5-7) 

Yi  * Yi.rYi 

(5-8) 

Hii  r- 
1 ai+l 

(5-9) 

This  set  of  equations  can  be  placed  in  a more  convenient  conqaitational 
form  by  replacing  Eq.  (5-6)  with  Eq.  (5-10),  which  is  obtained  by 
subtracting  Eq.  (5-5)  from  Eq.  (5-6).  Also,  if  Eq.  (5-7)  is  divided 
by  two  and  Eq.  (5-10)  is  subtracted  from  that  result,  Eq.  (5-11)  is 
obtained.  The  resulting  set  of  recursive  equations  is 


Ai 

+ Bi  + Ci 

-Yi 

for  i - 

1,2,. 

. . ,n-l 

(5-5) 

Bi 

+ 2Ci  * HiAi+l 

* *Yi 

for  i * 

1,2,. 

. . ,n-2 

(5-10) 

Ci 

* HiAi+l  - *i\+l 

sYi 

for  i * 

1,2,. 

,.,n-2 

(5-11) 

Eq.  (5-5)  is  also  applied  for  the  last  segment  (i  = n-1)  so  that  the 
curve  passes  through  y . The  total  number  of  unknown  coefficients 
is  3(n-l),  but  only  3(n-2)+l  conditions  have  been  specified.  There- 
fore, two  additional  conditions  must  be  given  to  uniquely  determine 
a cubic  spline  function  through  the  n points. 
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If  both  conditions  are  specified  at  one  end  point,  the  fitting 
process  is  simpler,  but  the  curve  can  exhibit  instabilities;  i.e.,  it 
may  oscillate  wildly  between  data  points  as  illustrated  in  Figure  5-2. 
This  condition  can  be  easily  avoided  by  selecting  one  condition  at 
each  end  point  of  the  curve.  The  digital  computer  algorithm  used  in 
the  following  cubic  spline  studies  was  taken  from  the  UNIVAC  1108 
Math-Stat  Library  [30] . It  allows  the  user  the  option  of  using 
either  the  first  or  second  derivatives  at  each  end  point.  It  is 
usually  more  convenient  to  use  the  first  derivative  conditions 
shown  in  Fqs.  (5-12)  and  (S-13). 


\ = *i  y’i 


B , + 2C 
n-1 


n-l  ~ an-l  ^ n ^n-I 


(5-12) 

(5-13) 
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5.2  UNIVAC  Spline  Fitting  Procedure 

The  IJNIVAC  cubic  spline  fitting  procedure  uses  Eqs.  (5-5), 


(5-10),  (5-11),  (5-12)  and  (5-13)  to  fora  a set  of  3(n-l)  equations 
that  can  be  written  using  a "tri -diagonal"  matrix  form: 
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(5-14) 


"Bi-diagonalization",  or  "uppeT-triangularization",  of  this  matrix 
is  possible  by  the  following  procedure,  which  will  also  be  mathe- 
matically summarized  after  the  description: 

a)  First  designate  the  second  row  of  the  matrix  as  the  i1*1 
row, 

b)  Subtract  the  equation  immediately  above  the  ith  row  from  it, 

c)  Replace  the  i^  row  equation  by  the  resulting  equation  of 
step  b)  after  it  is  divided  by  the  value  of  the  first  non- 
zero element,  c^,  and 
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d)  Now  designate  the  row  immediately  below  as  the  new  i row 
and  repeat  tire  process,  starting  at  step  b)  above. 

The  matrix  then  has  the  form 


— , 

— 

1 Cj  0 

Z1 

W1 

0 1 0 

Z2 

w2 

0 0 1 c3  0 

Z3 

w3 

...  0 1 c4  0 . . . 

Z4 

«E 

w4 

•••  0 1 c3n_4 

z3n-4 

w3n-4 

• 

0 1 

z3n-3 

w3n-3 

(5-15) 


where  the  3 (n-lj  -dimensional  z vector  consists  of  A^,  Bif  and  Ch 
coefficients  that  are  to  be  determined  and  the  v vector  consists  of 
appropriate  linear  combinations  of  the  elements  of  the  left -hand- 
side  vector  of  l'q.  (5-14). 

The  bi-diagonnlization  process  is  easily  summarized  by  the 
following  recursive  equations: 


CL  = 0 


(5-16) 
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C3i+1  = H.  - c3i 


(5-22) 
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Cnee  the  above  set  of  and  w^  values  is  computed  by  "forward" 
recursion,  the  final  coefficient,  Cn is  known: 

, . Vrw3n-4+a„-ly,n 

Vl  •»  z3n-3  “ w3n-3  ” I - c,  Z 


(5-23) 


(5-24) 


Then  the  "backward"  recursion  can  be  performed  to  evaluate  the 
remaining  polynomial  coefficients,  z^: 

1-^4  T~,C  7-n  f,  1 

iUi  I\  — ~»li  *r  f ^li  —'I*  u,  • • • 9 i- 

zk  = wk  * ck  Zk+i  (5-25) 

5 . 3 Direct  Slope-Determination  Spline  Fits 

The  alxive  process  for  spline  representation  required  the 
storage  of  five  values  for  each  data  point:  the  data  point  coor- 

dinates xi?  y.  ]>lu.'  the  Ait  and  Ci  coefficients.  Poirier  [22] 
indicates  that  some  of  this  information  is  redundant.  It  is  possible 
to  completely  reconstruct  the  spline  (and  its  derivatives)  from  only 
xi’  yi  ar)(^  y'i’  a 1:01:31  ol  rat^er  than  5n  values. 


y(x)  = (]  - 3o2  + 2o3)yi  + (3a2  - 2o3)yi+1 

+ [(a  - 2a2  + o3)y’i  + (u3  - °2)y\+1]  aj 
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While  this  direct-slope  determination  method  uses  the  sane  general 
procedures  as  the  UNIVAC  routine,  it  has  the  advantages  of  both 
requiring  less  spline  coefficient  storage  and  requiring  the  compu- 
tation of  fewer  coefficients.  The  UNIVAC  method  requires  computation 
of  9(n-l)  values:  the  c^  w^,  and  Zj,  3(n-l)  of  each.  The  latter 
method  requires  only  3(n-2)  values:  the  c^,  w^  and  y'^,  (n-2)  of 
each. 

5.4  End-Point  Slope  Estimates 

The  two  fitting  methods  require  end  point  slopes  to  uniquely 
define  the  fit.  For  terrain  systems,  only  the  data  points  themselves 
usually  are  available,  but  the  slopes  can  easily  be  estimated  from 
these  by  using  two,  three,  or  four  data  points  at  each  end  of  the 
terrain  segment.  This  corresponds  to  first,  second,  and  third  order 
slope  estimates,  respectively,  as  follows: 
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The  indices  are  ordered  starting  with  1 at  either  end  point  and 
counting  toward  the  interior  of  the  data  interval. 

Terrain  data  from  a typical  test  terrain  located  in  Pennsyl- 
vania (designated  6201)  [4]  is  used  in  the  studies  that  follow.  It 


is  classified  as  moderately  rough,  a 56^  f*et*  The  splines  are 
relatively  insensitive  to  the  otxler  of  the  slope  estimate  for  the 
typical  terrain  profile,  as  shown  in  Figure  5-3.  Therefore,  an 
extreme  test  profile  (oT  ■ 963  ft)  was  constructed  in  an  atteagit  to 
differentiate  between  the  three  types  of  estimates.  The  plots  for 
this  case  are  shown  in  Figure  5-4  and  do  show  seme  differences  at 
the  right  end.  However,  there  is  no  clear  choice  of  a best  fit,  so 
the  final  choice  for  actual  implementation  could  be  made  based  on 
the  ease  of  implementation,  which  would  be  the  simplest  one, 

Fq.  (5-35). 

5.5  Clearance  Curve  Determination 



In  the  determination  of  the  clearance  curve,  the  effect  of  * 

different  types  of  clearance  measurements  is  of  interest.  The 
measurement  considered  most  accurate  is  the  slant  clearance  (clearance 
to  the  nearest  terrain  point) , but  the  easiest  one  to  use  and  the 
one  most  frequently  used  in  terrain  following  is  the  vertical 
clearance.  The  two  types  will  be  compared  in  this  section. 

It  is  fairly  simple  to  compute  the  locus  of  points  that  have  a 
specific  normal  offset  distance  from  a cubic  spline  terrain  curve. 

Such  a locus  is  generated  by  continuously  moving  a line  segment  of 
the  specified  clearance  length  along  the  terrain  curve  so  that  it 
is  always  normal  to  the  terrain.  A 3000- foot -offset  curve  is  shown 
in  Figure  5-5  for  the  extreme-test  segment  constructed  earlier.  As 
indicated  in  the  figure  there  arc  problems  when  the  instantaneous 
radius  of  curvature  of  the  terrain  curve  becomes  smaller  than  the 
specified  offset  distance.  Loops  with  cusps  are  produced  on  the 
offset  curve.  The  obvious  method  for  obtaining  a clearance  curve 


Figure  S-7>  Typical  Terrain  with  Differ^.. t End  Slope  Estimates 


HEIGHT  (K  ft) 
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Figure  5-4  Extreme  Test  Terrain  with  Different  End  Slope  Estimates 

from  the  offset  curve  would  be  to  reject  those  points  on  the  offset 
curve  that  are  on  the  loops  or  near  the  crossover  point.  The  cusp 
at  the  crossover  point  is  undesirable  for  a smooth  clearance  curve. 
Proper  selection  of  points  from  the  offset  curve  for  cubic  splining 
was  the  approach  finally  considered  in  this  study.  The  elimination 
of  "improper"  points  on  the  offset  curve  is  not  a simple  procedure, 
hut  a method  for  doing  this  is  presented  in  Appendix  E.  The  slant 
clearance  curve  shown  in  Figure  5-5  was  obtained  by  this  method, 
which  is  considered  a minor  part  of  the  study,  since  the  presence  of 
loops  would  be  very  unlikely  for  practical  data  point  spacings  and 


real  terrains. 


vert ical 
clearance 


3-K  ft-offset 
curve 
slant 
clearance 


terrain  curve 
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Figure  5-5  Extreme  Test  Terrain  Clearance  Curves 
Also  shown  in  Figure  5-5  is  the  vertical  clearance  curve  which 
is  just  an  upward  translation  of  the  terrain  curve.  The  differences 
are  pronounced  for  the  extreme  case  shown;  they  would  not  be  as 
different  for  typical  terrains,  as  indicated  in  Figure  5-t>. 

An  alternate  approach  to  using  the  offset  curve  to  construct  a 
slant  clearance  curve  is  to  use  a "local"  estimate  of  the  vertical 
difference  between  the  slant  clearance  and  the  vertical  clearance 
curves.  The  tern  local  refers  to  the  fact  that  the  slope  and 
curvature  at  a single  point  on  the  terrain  curve  would  be  used  for 
the  estimate,  while  the  true  differences  are  determined  by  many 
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There  is  a simpler  approx imat ion  if  the  magnitude  of  x,  as  defined 
by  Eq.  (5-41),  is  very  small  compared  to  unity. 


2rn  (n-8)  _ 2nw(n-6) 


(0-nw)*- 
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(5-41) 


(5-42) 


(5-43) 


The  total  vertical  clearance  distance  for  the  estimated  curve  is  c . 

A comparison  of  the  three  types  of  clearance  curves  is  made 
in  Table  5-1.  The  slant -clearance  curve  is  used  as  a standard  of 
reference;  the  differences  between  each  of  the  other  two  clearance 
curves  and  it  are  listed.  The  data  in  the  table  are  given  for  two 
texte.U'.  profiles:  che  exlrcrc  test  segment  and  the  typical  terrain, 

segment,  which  were  shown  in  Figures  5-5  and  5-6,  respectively. 
Because  of  its  local  nature,  the  estimated  clearance  frequently 
corresponds  to  the  clearance  distance  for  the  lower  portion  of  a 
loop  when  loops  are  present  on  the  offset  curve.  This  is  an 
undesirable  feature,  as  can  be  seen  from  the  extreme-test  terrain 
clearance  data,  bui  the  typical  terrain  clearance  data  shews  that 
the  estimated  clearance  is  an  excellent  approximation  of  the  slant 
clearance  when  loops  arc  not  present  in  the  offset  curve.  Since 
the  estimated  clearance  requires  significantly  less  computation, 
it  would  be  3 good  selection  for  the  reference  clearance  path  in 
rough  terrain.  Estimated  clearance  is  used  for  the  clcaiancc  curves 
in  the  parametric  studies  in  Chapters  6 and  7. 
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| 

| Table  5-1  Comparison  of  the  Differences  ir  Clearance  Curve  Heights 

VC  - Vertical -Clearance  Curve 
SC  - Slam. -Clearance  Curve 
EC  - Estimated-Clearance  Curve 


Typical  Terrain 

Extreme  Tes 

t Terrain 

Range 

VC-SC 

EC -SC 

VC-SC 

EC-SC 

(All  Values 

in  Feet) 

2000 

- .20 

- .10 

- 89.3 

- 52.5 

4000 

- .28 

.00 

- 50.8 

+ 1.6 

6000 

- .00 

.00 

- 215.5 

+ 25.3 

8000 

- .80 

.00 

-1400.3 

-1159.5 

10000 

- .26 

.00 

-1722.5 

-1716.8 

12000 

- .86 

.00 

- 395.5 

- 102.7 

14000 

-2.34 

+ .02 

- 102.8 

+ 124.6 

16000 

-8.74 

+ .02 

- 118.4 

- 104.9 

18000 

-3.02 

.00 

- 927.8 

- 883.5 

20000 

-7.06 

- .06 

- 424.6 

0.0 

22000 

-4.08 

- .02 

24000 

-6.  S3 

- .02 

26000 

-8.72 

+ .08 

28000 

-1.14 

.00 

300CC 

- .86 

.00 

32000 

-4.66 

+ .04 

34000 

•7.20 

- .02 

36000 

- .18 

.00 

38000 

-4.00 

+ .02 

a norm 

*»  WUU  V' 

- .36 

. 00 

42000 

- .36 

.00 

44000 

- .68 

.00 

46000 

-ti.44 

.00 

48000 

-S.32 

+ .02 

50000 

-3.10 

+ .02 
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0.  REFERENCE  PATH  DETERMINATION 
AND  PARAMETRIC  STUDIES 

The  previous  chapters  developed  the  optimization  problem  for  the 
determination  of  a reference  path  and  discussed  the  parameters 
affecting  that  problem.  In  this  chapter  various  solutions  of  the 
optimization  problem  are  considered,  as  well  as  some  of  the  charac- 
teristics of  the  algorithms  that  are  used  to  compute  those  solutions. 
Two  basic  approaches  to  solving  the  problem  are  discussed:  the 

first  is  a penalty  function  method  of  treating  clearance  constraints, 
the  second  and  preferred  approach  is  to  treat  the  constraints 
directly  by  the  mathematic il  programming  method.  The  discussion 
of  the  penalty  function  approach  is  brief  and  is  included  only 
because  it  is  one  that  is  frequently  used  with  state  variable 
inequality  constraints,  and  some  interesting  charact 'ristics  are 
observed  when  usi  tg  it. 

6.1  Penalty  Function  Approach 

The  first  approach  is  an  exterior  penalty- function  method 
utilizing  a general  parameter- search  optimization  algorithm.  The 
penalty  function  limits  the  clearance  constraint  violations  and 
search-direction  limits  enforce  the  curvature  constraints.  A 
Davidon  rank-one  search  algorithm  [9]  is  used.  The  rank-one  algor- 
ithm is  not  as  commonly  used  as  the  Davidon  rank-two  algorithm, 
which  icquiies  a one-dimensional  optimization  along  the  search 
direction  in  parameter  space.  The  rank-one  algorithm  was  selected 
because  it  lias  a sell -adjusting  step  size  that  docs  not  require  a 
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one -dimensional  optimization  along  each  search  direction  and  it 
was  felt  that  fewer  iterations  would  be  required.  Both  algorithms 
use  estimates  of  the  variance  (the  inverse  of  the  Hessian  matrix)  to 
establish  search  directions  in  the  parameter  space.  The  rank-one 
method  updates  the  variance  estimate  with  a matrix  of  rank-one,  based 
on  the  gradient  vector.  Details  of  the  method  are  found  in 
Reference  9. 

The  penalty  function  creates  convergence  problems  near  the 
final  solutions,  because  of  the  artificially  steep  cost  surfaces 
introduced  by  the  penalty  term.  This  is  a problem  discussed  by 
Beltrami  [5J  and  others  117].  To  further  complicate  convergence, 
the  parameter  limits  on  curvature  also  inteirupt  the  normal  search 
procedure.  The  Davidon  routine  was  modified  to  reduce  the  effective 
dimension  of  the  search  whenever  a parameter  space  boundary  was 
encountered.  This  was  done  by  reducing  the  rank  of  the  variance 
estimate  appropriately.  However,  once  the  rank  was  reduced,  the 
search  remained  on  the  corresponding  bo'irdary.  To  allow  for  flex- 
ibility so  that  the  search  could  leave  the  boundary,  special  tests 
and  procedures  to  increase  the  rank  of  the  variance  had  to  be  in- 
corporated. The  technique  is  il  ustrated  in  Figure  6-1,  for  a 
search  in  a two-dimensional  spate.  The  level  curves  of  the  cost 
junction  are  sketched  and  the  negative  gradient  directions  arc 
indicated  by  arrows  along  a possible  search  patn.  If  one  of  the 
boundaries  is  encountered  during  the  search,  the  method  searches 
the  boundary  surface  by  reducing  the  variance  in  rank  (to  a rank  of 
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Figure  b-1  Bounded  Parameter  Search 


j one,  in  the  example) . Any  time  the  negative  cost  gradient  points 

1 out  of  the  allowable  parameter  space  the  search  continues  on  the 

! 

boundary,  but  if  the  negative  gradient  points  inward  the  variance 

I 

! rank  is  increased  again  to  allow  the  search  to  leave  the  boundary. 

( 

The  procedure  works  fairly  well,  but  when  coupled  with  the  penalty 

I function  ill- conditioning  there  are  regions  where  the  method 

l 

tends  to  jump  on  and  off  the  boundary  as  it  jumps  back  and  forth 

| across  the  penalty  function  valley.  This  difficulty  could  probably 

i 

| bo  eliminated  by  an  acceleration  scheme  such  as  those  discussed  by 

■ Beltrami  [5],  and  Kelley  and  Denham  [17],  Sequential  increases 

i 

i 

J in  the  penalty  function  coefficient  improve  the  convergence  for 

! some  problems,  but  stepping  tiu  coefficient  does  not  help  signifi- 

! cantiy  for  this  problem.  This  is  due  to  the  nature  of  the  parameter 

i 

i cost  relationship.  Trajectories  which  lie  very  close  to  one 

i 

i 

1 
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anotlK'r  in  position  space  may  differ  in  all  the  curvature  parameters 
— not  just  in  one  or  two.  Small  changes  in  the  near  frame  parameters 
cause  larger  changes  in  the  far  frane  trajectory  because  of  the  double 
integration  of  the  control  function.  So  it  is  not  easy  to  go  from 
the  solution  for  one  penalty  coefficient  to  that  of  another,  because 
of  the  complicated  interaction  of  sensitivities  and  constraints. 

The  moderately  rough  terrain  segment  shown  previously  in 
Figure  5-3  is  used  to  test  all  of  the  optimization  approaches  con- 
sidered in  this  chapter.  A typical  penalty  function  solution  is 
shown  in  Figure  6-2.  The  framing  structure  for  this  solution  is 
Structure  1 in  lable  6-3  on  page  86,  which  gives  the  structures  for 
all  of  the  cases  considered  in  this  cliapter.  The  number  of  iterations 
required  for  the  solution  to  converge  is  very  large  for  sane  frames 
when  the  penalty  function  approach  is  used.  However,  the  rate  of 
convergence  is  rather  rapid  at  first  and  then  slows  considerably 
as  the  number  of  iterations  increases.  This  fact  is  confirmed  by 
Figure  6-3,  which  depicts  solutions  with  various  limits  imposed 
upon  the  number  of  iterations  in  each  optimization  frame.  Very 
little  improvement  is  observed  in  the  path  when  more  than  80 
iterations  per  frame  are  allowed.  The  case  with  a 150  limit  has 
slightly  greater  clearance  violation,  but  the  path  also  goes  slightly 
lower  into  the  valleys  tlian  that  for  the  80-limit  case.  There  is 
essentially  no  difference  between  the  500-limit  path  and  the  p'th 
without  limits  shown  in  Figure  6-2.  Therefore,  the  large 


Figure  6*2  Typical  Penalty -Function  Optimal  Path 


it irnnl  Paths  with  Various  Iteration  Limit 
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number  of  iterations  are  not  really  needed  for  reasonable 
performance.  The  final  path  refinement  is  not  significant,  while 
the  computation  time  required  for  it  is  large.  The  solution  times 
eorresimnding  to  the  various  limits  are  given  in  Table  6-1  for 
framing  Structure  1 (Table  6-3).  These  times  are  compared  to  the 
solution  times  for  the  quadratic  programming  routines  which  will 
be  discussed  below. 


Table  6-1  Central  Processor  Solution  Times 


Approach 
Penalty  Function 


Iteration  Limit 
Per  Frame 


Average  Time 
Per  Frame  (Sec) 


80 

150 

500 

none 


3 

8 

11 


Quadratic  Programming 
Shankland 


Lemke - Ravi ndran 


none 

none 


The  penalty  function  approach  requires  more  computer  time  and  does 
not  have  well  defined  lower  clearance  bounds;  therefore,  the  pro- 
gramming solutions  are  a much  better  approach. 

6 . 2 Quadratic  Programming  Problem  Approach 

Two  quadratic  programming  algoritlmis  are  used  to  obtain  solutions 
to  the  optimization  problem.  Shank land's  algorithm  [ 29]  uses  the 
direct  quadratic  programming  formulation  described  in  Section  3.4, 
while  the  Lemke -Ravi ndran  algorithm  [26]  is  based  on  the  complementary 
problem  of  Section  3.5. 
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• Shankland's  method  seeks  to  find  a solution  by  iteratively  en- 

forcing various  sets  of  the  inequality  constraints  as  equality  con- 
straints. Tltc  projxsr  set  of  constraints  is  found  by  considering  the 
control  vector  tluit  maximizes  the  performance  index  subject  to  the 
enforced  equality  constraints.  The  maximizing  control  vector  at 
any  particular  iteration  step  may  violate  some  of  the  inequality 
constraints  that  are  not  imposed  at  that  particular  step.  The 
iterative  procedure  selects  some  of  the  violated  constraints  for 
addition  to  the  imposed  set  by  minimizing  the  Euclidean  norm  of  the 
| constraint  violation  vector.  If  a solution  exists  the  violation  is 

; driven  to  zero.  If  a solution  does  not  exist,  the  violation  vector 

! is  minimized.  This  is  a definite  advantage  when  numerical  errors 

moke  the  problem  "slightly  infeasible." 

The  Siumkland  algorithm  does  require  a positive-definite 
quadratic  irerformancc  matrix,  so  it  is  not  as  flexible  for  performance 
criteria  investigations  as  the  Lemke  methc  , in  which  the  quadratic 

| matrix  can  be  set  to  zero  for  a linear  performance  criteria.  However, 

( 

! the  Shankland  method  requires  considerably  less  storage  space  than 

I the  Lemke  algorithm  uses,  since  it  does  not  store  the  complete 

i 

I complementary  problem  matrix.  If  Q and  C are  designated  as  the 

i 

\ quadratic  cost  matrix  and  the  complete  constraint  set  matrix, 

| respectively,  their  dimensions  are  indicative  of  the  storage  space 

required  for  Shankland's  method,  but  the  Lemke  routine,  as  used, 
combines  these  matrices  into  the  much  larger  R matrix  with  a large 
nunber  of  zeroes  in  the  lower  right  comer. 
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(Typically  the  zero  matrix  may  be  40  x 40  or  larger).  It  is  possible 
to  reprogram  the  Lemke  algorithm  to  take  advantage  of  the  zero 
matrix,  but  the  optimization  of  the  computer  programing  is  beyond 
the  scope  of  this  study. 

The  solution  of  each  data  frame  is  essentially  the  same  for 
both  algorithms.  The  Lemke  routine  is  chosen  for  further  analysis 
because  of  its  flexibility,  but  it  is  not  necessarily  rec amended 
for  use  in  an  operational  system.  The  Lemke  algorithm  used  in  this 
study  is  one  revised  by  Ravindran  to  use  a special  Revised  Simplex 
search.  This  algorithm  worked  extremely  well,  except  for  very  large 
M matrices  of  dimension  near  100.  (Ravindran' s routine  was  originally 
limited  to  a dimension  of  SO).  For  the  large  dimensional  cases,  a 
large  number  of  iterations  caused  a build-up  of  round  off  errors  in 
the  recursively  calculated  matrices,  until  reasonable  solution 
accuracy  was  lost  on  some  particular  data  frames.  The  more 
reasonable  60-dimensional  problems  produced  solution  accuracies  of 
approximately  seven  significant  digits.  This  accuracy  is  determined 
by  comparison  of  the  two  sides  of  the  complementary  problem  vector 
equation  (Eq.  3-39).  Similar  numerical  difficulties  are  experienced 
during  a matrix  decomposition  routine  used  in  the  Shankland  method 
when  large  dimensional  optimizations  are  attempted. 

A comparison  of  the  successive  frame  solutions  using  the  penalty 
function  and  the  quadratic  programming  approaches  is  shown  in 


V 


81 


Figure  6-4  for  framing  Structure  1.  Although  it  is  more  natural  to 
think  of  the  control  variable  in  terms  of  acceleration,  the  curvature 
is  plotted  throughout  these  studies.  The  curvature  is  more  closely 
related  to  the  path  and  it  includes  the  effects  of  both  acceleration 
and  velocity.  For  example,  the  curvature  limits  in  Figure  6-4  of 
0.0000875  and  -0.000017S  ft'*  correspond  to  +3.4  and  -0.68  G's  at 
Mach  1 (V“1117  fps),  or  to  +0.85  and  -0.17  G's  at  Mach  0.5  (VM558  fps). 
To  give  tlie- reader  a feeling  for  the  control  magnitude,  the  acceler- 
ation limit  corresponding  to  each  curvature  limit  is  shown  in  the 
figures  and  is  based  on  a nominal  velocity  of  894  fps  (Mach  0.8), 
unless  otherwise  specified.  This  is  the  velocity  used  in  the  air- 
craft simulations  discussed  in  Chapter  7. 

The  framing  process  is  illustrated  also  in  Figure  6-4.  Three 
frames  are  shown  with  a frame  advance  distance  of  4000  feet.  This 
same  advance  is  used  for  most  of  the  studied  framing  structures. 

It  is  chosen  to  be  small  compared  to  the  frame  lengths  used,  and 
it  is  held  constant  to  minimize  any  interactions  between  other 
framing  parameters.  Oily  the  portions  of  the  optimal  paths  in 
each  of  the  advance  intervals  is  used  for  guidance  in  real  time 
application. 

The  penalty  function  trajectory  lies  lower  than  the  quadratic 
programing  trajectory,  but  it  also  violates  the  clearance  constraints. 
If  the  lower  clearance  values  are  acceptable,  it  is  preferable  to 
intentionally  set  the  clearance  level  lower  than  to  allow  violations 
of  the  clearance  level.  This  would  provide  more  reliable  control  of 
the  minimum  clearance  distance. 
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6.3  Performance  Criteria  Study 

An  important  concern  in  terrain  following  is  the  criterion  for 
"closeness."  Quadratic,  linear,  and  m in-max  criteria,  based  on  the 
clearance  distance  above  the  reference  clearance  curve,  are 
considered  here.  The  effect  of  the  squared  term  in  the  quadratic 
cost  function  is  to  emphasize  large  clearance  errors  more  than 
small  errors.  The  min-max  criteria  goes  even  further  in  this 
direction. 

6.3.1  Quadratic  and  Linear  Performance  Measures.  The  linear 
performance  measure  can  be  considered  as  a special  case  of  the 
quadratic  measure  where  the  squared  term  coefficient,  of  Eq.(3-2) 
is  set  to  zero.  Before  the  study  of  the  coefficient  values  of  Qn 
and  was  conducted,  it  was  assumed  that  a change  in  the  ratio  of 
these  coefficients  could  make  a significant  change  in  the  solution. 
The  values  of  and  LR  are  the  same  for  each  sample  point,  but 
to  "normalize"  the  performance  measure,  these  values  were  based 


on  the  number  of  sample  points.  That  is,  values  of  Cq  and  c^  were 
specified  and  the  Qn  and  Ln  were  computed  from  these  and  the 
number  of  performance  measure  sample  points,  Np. 

q ( 

<n  N 1 

” N,,  ' 


Four  sets  of  coefficient  values  are  shown  in  Table  6-2,  and  the 
corresponding  trajectories  are  essentially  the  same,  even  though 
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there  are  some  slight  differences  in  the  curvature  controls,  as 
shown  in  Figure  6-5.  The  data  in  Table  6-2  are  for  seven  frames 
based  on  Structures  2 through  5 of  Table  6-3.  The  framing 
structures  are  identical  except  for  the  performance  coefficients. 


Table  6-2  Cost  Coefficient  Comparison 


Framing 
Structure  Nr. 

B 

Jl_ 

Total  Nr. 
of  Iterations 

Computation 
Time  (Sec) 

2 

A 

.0 

210 

9.0 

3 

A 

.001 

206 

S.9 

4 

A 

.1 

291 

9.8 

5 

.0 

.1 

329 

10.7  • 

Contrary  to  what  was  initially  expected,  the  trajectories  are 
quite  insensitive  to  the  values  of  the  cost  coefficients.  After  a 
little  reflection  this  is  not  too  surprising;  the  trajectories  for 
the  terrain  following  pi-oblem  tend  to  be  very  constraint  bound. 

The  major  portions  of  them  are  on  some  form  of  constraint  boundary: 
a maxinun  pull  up,  a maximum  push  over,  or  a clearance  curve 
boundary.  The  optimization  problem,  then,  consists  primarily  of 
piecing  these  different  types  of  trajectory  arcs  together  at  the 
proper  points  with  suitable  transition  arcs.  This  is  just  the  type 
of  procedure  that  terrain- following  investigators  have  attempted  to 
do  Cor  some  time  now  in  the  construction  of  ideal  paths,  but  the 
schemes  have  not  been  applicable  to  real  time  implementation 
(except  for  that  of  Greaves). 

Although  the  linear  performance  measure  (last  one  in  Table 
6-2)requires  slightly  more  computation  time  with  the  Lemke  algorithm. 
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it  is  worth  noting  that  it  Joes  liave  significant  advantages.  The 
Lemke  routine  was  used  for  this  linear  case  because  of  its  flexi- 
bility, but  other  linear  programming  algorithms  could  be  used.  Some 
would  require  less  computer  storage  and  would  probably  be  faster, 
since  the  dimension  of  the  overall  programming  problem  would  be 
reduced  from  that  of  the  complementary  problem. 

6.3.2  Min-Max  Criterion.  Although  minimizing  the  maximum  vertical 
distance  above  the  reference  clearance  path  seems  to  be  a reasonable 
criterion,  it  does  stress  one  critical  clearance  distance  on  the 
data  frame  interval.  Figure  6-6  shows  the  composite  solutions  from 
three  successive  data  frames  using  the  min-max  criterion,  with  * 

* 0,  compared  to  the  solutions  for  the  quadratic  criterion. 

These  correspond  to  framing  Structures  6 and  8,  respectively,  of 
Table  6-3.  Notice  that  the  optimal  path  for  the  min-max  criterion 
does  not  follow  the  smoother  portions  of  the  clearance  path  as 
closely  as  does  that  of  the  other  criterion,  where  the  optimal  path 
coincides  with  the  clearance  path  unless  the  curvatures  are  too 
great.  Another  disadvantage  of  the  min-max  measure  is  that  the  upper 
limit  constraints  on  the  clearance  values  increases  the  dimension 
of  the  programing  problem  (a  linear  one)  with  additional  constraint 
equations.  Since  the  difference  in  clearance  maxima  for  the  two 
paths  in  Figure  6-6  is  less  than  two  feet,  the  disadvantages  outweigh 
the  advantages  for  this  performance  measure. 

6.4  Frame  Length  Study 

The  characteristic  frame  length  was  developed  in  Section  4.1 
to  estimate  the  minimum  frame  length  required  for  good  terrain 
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Figure  6-6  Min-Max  vs.  Quadratic  Cost  Solutions 

following  performance.  This  portion  of  the  study  tests  the  validity 
of  that  estimate.  The  computational  details  of  the  characteristic 
frame  lengths  and  control  intervals  for  the  "hard"  and  "soft"  rides 
are  tabulated  in  Appendix  B.  The  frame  length  values  of  18,800 
and  30,800  feet  are  based  on  a maximum- expected-obstacle  height 
of  1000  feet  and  on  the  framing  Structures  7 and  10  of  Table  6-3. 

To  study  the  effects  cf  frame  length  on  the  framing  process, 
three  different  frame  lengths  are  compared  for  each  of  the  charac- 
teristic lengths.  One  length  is  approximately  equal  to  the 
characteristic  length,  one  is  shorter,  and  one  is  longer.  The 
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lengths  used  in  the  study  are  given  in  Table  6-4,  along  with  a 
sirmary  of  other  pertinent  framing  parameters.  The  complete  sets 
of  framing  parameters  .arc  those  for  Structures  7 through  12  in 
Table  6-3.  Table  6-4  also  gives  the  characteristic  control  intervals 
and  the  actual  intervals  used  for  the  optimization  solutions. 

Table  6-4  Frame  Length  Study  Data 


Type  of 
Hide 

Control 

Interval 

(ft) 

Characteristic 

i 1 

Frame 

Interval  Length 
(ft)  (K-ft) 

Frame  Complem. 
Length  Problem 
(K-ft)  Dim. 

Comput.  Time 

. Nr.  of  Avg. 

Frames  Frame  Total 
in  Run  (Sec)  (Sec) 

Hard 

1000 

1440 

18.8 

12 

36 

10 

0.9 

8.9 

(-1.+2  G's) 

20 

60 

8 

2.4 

21.5 

V-894  fps) 

28 

84 

6 

6.2 

37.1 

Soft 

2000 

840 

30.8 

20 

40 

8 

0.8 

6.6 

(-.25, *2  G' 

's 

32 

64 

S 

1.6 

8.2 

V-894  fps) 

44 

88 

2 

3.1 

6.2 

The  large  control  interval  is  used  for  the  soft  ride  to  reduce 
the  number  of  sample  |>oints  and,  hence,  the  dimension  of  the 
optimization  problem.  The  acceleration  values  shown  in  the  figure 
are  for  two  sets  of  curvature  values  at  Mach  0.8.  The  same  control 
interval  is  used  for  each  case  in  a particular  ride  set;  thus,  the 
frame  length  is  the  only  framing  parameter  varied  in  each  set. 

The  hard  ride  optimal  paths  and  controls  are  shown  in 
figure  6-7.  The  two  longest  frame  lengths  (20  and  28  K-ft)  produce 
essentially  the  same  paths.  Tins  indicates  that  any  frame  length 
greater  than  20,000  feet  is  not  needed.  The  shortest  frame  length 
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represents  a 40i  range  reduction  from  the  mid-length  case.  The 
corresponding  reduction  in  predictive  capability  produces  small 
degradations  in  performance  after  the  terrain  peaks.  The  charac- 
teristic estimate  of  18,800  feet  agrees  well  with  the  length  of 
20,000  feet  that  provides  good  performance  over  the  test  terrain 
segment . 

For  the  soft  ride,  the  two  paths  corresponding  to  the  two 
longest  frame  lengths  are  also  essentially  the  same,  even  though 
there  are  minor  variations  in  their  curvature  profiles,  as  shown  in 
Figure  6-8.  The  shortest  frame  length  is  a reduction  of  60%  in 
range  from  the  mid -length  case.  This  large  reduction  causes  a 
corresponding  significant  decrease  in  performance  after  the  peaks. 
The  use  of  a control  interval  significantly  larger  than  the  charac- 
teristic control  interval  may  also  be  a factor  contributing  to  the 
performance  degradation.  Once  again,  the  characteristic  frame 
length  of  30,800  feet  appears  to  be  a good  estimate  of  what  is 
required  for  good  performance  in  Figure  6-8  (approximately  32,000 
feet) . 

The  total  time  comparison  for  the  soft  ride  in  Table  6-4  is 
misleading  due  to  the  disproportionate  length  of  the  longest  frame 
compared  to  the  total  range  of  the  inn  (48,000  ft).  Table  6-5  shows 
a more  detailed  comparison  of  the  run  times  for  the  soft  ride  with 
the  two  longest  frame  lengths.  (The  shortest  frame  length  run  was 
not  considered  in  this  comparison  since  its  performance  was 
significantly  worse).  The  average  frame  times  are  used  to  predict 
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computation  times  for  two  longer  runs.  Since  the  range  covered  by 
successive  frame -advance  intervals  is  the  portion  used  for  guidance, 
those  corresponding  portions  must  be  coupara^le  for  two  different 
frame  lengths  if  the  run  time  comparison  is  to  be  meaningful.  As 
the  total  range  of  the  run  increases,  the  advance  coverage  for  the 
cases  shown  in  the  table  becomes  more  nearly  equal.  As  expected, 
the  longer  frame  length  requires  longer  run  times,  just  as  it  did 
for  the  hard  ride  comparison. 


Table  6-5  Soft-Ride  Computational  Run  Time  Predictions 


Run 
Length 
(K- ft) 

Frame 

Length 

(K-ft) 

Avg. 

Frame 

Time 

(Sec) 

Number 

of 

Frames 

Frame  Total 

Advance  Time 

Coverage  (^Predicted) 
(K-ft)  (Sec) 

48 

32 

1.6 

5 

16 

8.2 

44 

3.1 

2 

4 

6.2 

72 

32 

1.6 

11 

40 

18.0* 

44 

3.1 

8 

28 

24.8* 

96 

32 

1.6 

17 

64 

27.8* 

44 

3.1 

15 

52 

46.5* 

Comparison  of  figures  6-7 

and  6-8 

indicates  that  as 

the  maneuver 

ability  of  the  vehicle  decreases  the  predictive  capability  of  the 
control  system  must  increase;  i.e.,  the  system  must  "look"  further 
ulicad.  furthermore,  narrowing  the  acceleration  span  increases  the 
vehicle's  flight  range,  but  it  also  increases  the  mean  clearance 
of  the  path.  The  increase  in  possible  flight  range  of  the  vehicle 
can  be  verified  by  considering  the  curvature  profiles.  The 
magnitudes  of  the  curvature  values  are  an  indication  of  the  induced 
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drag  on  the  vehicle  nt  any  time.  As  the  induced  drag  increases  the 
flight  range  decreases  for  a given  fuel  supply.  If  total  range 
is  critical,  u compromise  must  be  made  between  the  acceleration- 
limit  span  and  the  mean  clearance  altitude  for  the  flight. 

6.S  Control -Point  Spacing 

The  spacing  of  the  control  points  certainly  affects  the 
resulting  trajectories  in  regions  where  the  control  is  not  an  a 
curvature -constraint  boundary  for  an  extensive  distance.  This 
is  illustrated  in  Figure  6-9  by  three  cases  with  different  control 
intervals.  All  other  framing  parameters  are  held  constant,  as 
indicated  in  Table  6-3  by  Structures  13  through  IS.  To  prevent  the 
problem  dimension  from  becoming  too  large  for  the  finest  control - 
jioint  spacing  (500  feet),  the  last  half  of  the  frame  uses  a 1000-ft 
spacing. 

On  the  fourth  frame  of  the  run  with  SOO-ft  spacing,  computational 
difficulties  were  encountered.  Because  of  solution  inaccuracies  due 
to  round-off  error  accumulation  from  the  third  frame,  the  fourth 
frame  had  an  infeasible  solution- -the  path  was  slightly  below  the 
miniirun  clearance  curve  at  the  beginning  of  the  frame.  Therefore, 
this  run  only  covered  a total  range  of  28,000  feet,  while  only 
14,000  feet  of  that  range  was  covered  by  the  500-ft  interval  spacing 
of  the  control  |>oints.  The  majority  of  the  remaining  range  is 
composed  of  pushover  arcs.  These  portions  are  very  predictable  in 
nature.  Therefore,  the  portion  shown  in  the  figure  is  fairly 
representative  of  the  behavior  with  the  fine  control -interval  spacing. 


•*T.  Uf. 
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The  behavior  more  closely  resembles  a bang-bang  control  than  does 
either  of  the  other  two  spacing*.  The  finely  spaced  control  has 
the  largest  kink  values  and  the  largest  excursions  in  curvature. 

This  places  a much  heavier  stress  on  the  tracking  and  flight -control 
systdms,  as  well  as  the  structural  components  of  the  vehicle. 
Vibration  and  fatigue  may  become  serious  problems  for  prolonged 
flights  in  this  regime. 

A comparison  of  the  run  times  for  the  control  interval  study 
is  shown  in  Table  6-6.  The  fine- spacing  runs  not  only  require  nuch 
greater  computation  time  and  taxes  the  control  system  more  heavily, 
but  it  decreases  the  total  flight  range,  while  lowering  the  trajec- 
tory only  slightly  in  some  regions.  For  these  reasons,  the  numerical' 
problems  with  this  framing  structure  are  not  pursued  further, 
although  programing  refinements  could  probably  overcome  the 
difficulties. 

Table  6-6  Control-Point  Spacing  Parametric  Data 

Computation  Time  (Sec) 


Control 

Interval 

(ft) 

Nr.  of 
Control 
Points 

Complementary 

Problem 

Dimension 

Nftjnber 

of 

Frames 

Average 

PeT 

Frame 

Total 

soo 

30 

80 

4 

6.7 

26.9 

1000 

20 

<>0 

8 

2.4 

21.5 

2000 

10 

40 

8 

1.0 

7.8 

There  must  be  a compromise  between  small  control  intervals  to 
allow  the  path  to  follow  the  terrain  more  closely  and  large  control 
intervals  which  reduce  the  computational  and  control  rate 
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requirements.  The  particular  vehicle  and  mission  must  be  considered 
in  making  this  decision. 

6.6  Slope  Constraints 

Slope  constraints  on  the  flight  path  have  usually  been  applied 
in  previous  designs  to  prevent  the  aircraft  from  descending  too 
deeply  into  valleys,  from  which  steep  recoveries  are  required, 
followed  by  excessive  overshoot  of  the  terrain  peaks.  For  this 
reason,  slope  constraints  have  not  been  applied  in  this  study  prior 
to  this  point.  For  sane  applications,  definite  requirements  do 
exist  for  slope  constraints,  such  as  for  transport  aircraft  or  for  a 
"let-down"  from  high  altitude.  The  effect  of  a dive  constraint  (-0.1 
minimum  slope  limit)  on  the  optimal  path  is  shown  in  Figure  6-10. 

No  positive  slope  limit  was  imposed  in  this  case.  The  slope- 
constrained  path  is  compared  to  one  without  slope  constraints;  these 
two  cases  use  framing  Structures  16  and  17  of  Table  6-3.  The  paths 
appear  very  much  as  one  would  expect,  with  flattened  let-down 
segments  in  the  regions  where  the  negative  slope  constraints  are 
active.  However,  the  curvature  profiles  show  that  there  is  not 
sufficient  time  for  the  path  to  reach  an  equilibrium  condition  of 
zero  curvature  over  any  appreciable  interval  in  these  regions. 

The  addition  of  the  dive  constraint  increased  the  complementary 
problem  dimension  from  60  to  80.  The  maximum  desirable  dimension 
for  the  Lemke-Ravindran  routine  appears  to  be  approximately  eighty, 
but  other  algorithms  could  probably  handle  higher  dimensional 
problems,  particularly  the  linear  programing  algorithms. 
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'Hie  choice  of  various  framing  parameters  should  be  based  on 
overall  system  considerations,  including  tracker  performance,  which 
is  discussed  in  the  following  chapter.  !t  should  be  emphasized 
that  most  of  the  changes  in  framing  parameters  that  may  be  desired 
for  various  trade-offs  do  not  involve  computer  program  changes; 
the  omy  required  changes  arc  numerical  data  values.  Therefore, 
the  optimization  scheme  is  very  flexible. 


* 


nttrtftfitn 


7.  SIMULATIONS  OF  THE  TRACKER  SYSTEM 


A variety  of  tracker  systems  can  be  used  to  make  the  aircraft 
follo«  the  optimal  paths  presented  in  the  previous  chapter.  However, 
one  of  the  goals  of  the  optimization  problem  is  to  obtain  a path  that 
can  be  easily  followed,  and  the  solution  of  the  optimization  problem 
provides  nuch  more  information  than  is  available  in  other  types  of 
path  processors.  All  derivatives  of  the  optimal  path  are  available 
to  provide  the  tracker  with  sane  predictive  capability.  The  block 
diagram  for  the  general  tracker  system  is  shown  in  Figure  7-1. 


Figure  7-1  General  Tracker  System  Diagram 

The  derivatives  shown  are  with  respect  to  range,  rather  than  time, 
so  the  coordinate  transformations  of  Eqs.  (7-1)  and  (7-2)  are  required 
either  in  the  navigation  or  tracker  system. 


x'  - t'  x (7-2) 

This  conversion  is  considered  more  appropriate  than  tlic  use  of  the 
time  domain,  since  terrain  is  fixed  in  the  range  domain  and  control  of 
the  path  with  respect  to  the  terrain  is  the  ultimate  aim  of  the  control 
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system.  To  test  the  optimal  paths  that  have  been  generated  for 
tracking  feasibility,  a simple  tracker  system  is  combined  with  a sim- 
ulation of  an  aircraft.  The  specific  tracker  system  studied  is 
diagramed  in  Figure  7-2. 


Figure  7-2  3 -Channel  Optimal-Path  Tracker  System 

To  determine  pitch  commands,  three  error  signals  are  used:  the 
altitude  error  and  its  first  and  second  derivatives  with  respect  to 
range.  Each  error  is  based  on  a comparison  of  the  optimal-path  value 
with  the  aircraft's  actual  value  as  determined  by  the  navigation 
system.  Since  the  optimal  path  is  computed  with  continuous  first  and 
second  derivatives,  and  the  aircraft  values  are  continuous,  the 
error  signals  are  also  continuous.  Since  a range  interval  of  optimal- 
path  data  is  available  prior  to  its  use  by  the  tracker  system,  a 
pure  advance  in  range  of  the  optimal  curvature  signal  is  feasible  to 
compensate  for  lags  in  the  overall  aircraft  system.  However,  the 
effects  of  lag  are  minor  for  the  aircraft  in  this  simulation,  so 
this  possibility  is  not  pursued  further. 

The  tracker  system  does  not  require  "full  state  variable  feedback", 
but  it  does  require  a coordinate  transformation  to  convert  the  aircraft 
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notion  firm  tine  dependency  to  range  dependency.  The  nonlinear  air- 
craft model  has  eight  state  variables,  but  only  three  variables  are 
fed  back  for  the  tracker  system  employed  here:  h,  h' , and  h". 

The  simplifying  assumptions  made  in  the  simulation  are  as 
follows: 

1)  The  atmospheric  density,  p,  and  the  speed  of  sound  are 
constant, 

2)  The  center-of- gravity  of  the  aircraft  does  not  change  during 
the  flight  segment,  and 

3)  Perfect  navigation  data  on  the  aircraft  state  are  available. 

The  particular  aircraft  data  used  for  the  simulation  are  for  the  F-4C, 
and  the  model  is  made  as  accurate  as  possible  for  the  data  available 
[12] . The  simulation  model  incorporates  a stability  augmentation 
system  (SA5)  and  a linear  model  of  the  control -surface  actuator.  A 
limiter  is  included  to  prevent  the  commands  from  driving  the  control 
surface  past  its  physical  stops,  which  allow  a total  stabilator 
rotation  of  28°.  The  aerodynamic  moment  and  forces  are  computed  as 
linear  combinations  of  the  state  variables,  with  the  stability 
derivatives  as  coefficients;  however,  the  nonlinear  dynamic  equations 
for  aircraft  motion  are  used.  This  provides  a more  accurate  aircraft 
model  than  the  completely  linearized  one  frequently  used  to  investigate 
aircraft  control  systems.  The  aircraft  equations  of  motion  and  data 
arc  given  in  Appendix  (5.  The  nominal  flight  speed  for  all  runs  is 
Mach  0.8  at  sea  level  (894  fps). 
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The  spatial  frequency  content  of  the  input  signals  to  the  tracker 
are  determined  strictly  by  the  character  of  the  optimal  path.  The 
curvature  and  kink  limits,  the  control  point  spacing,  and  the  terrain 
data  affect  the  frequency  content  of  the  optimal  path.  Therefore,  the 
set  of  tracker  gains  that  minimises  the  tracking  errors  is  dependent 
upon  the  framing  structure  as  well  as  the  terrain.  It  is  possible 
to  change  the  gains  in  the  tracker  based  upon  the  particular  framing 
structure  selected  and  upon  the  anticipated  terrain  roughness; 
however,  a set  of  fixed  gains  worked  well  for  all  of  the  framing 
structures  tested  in  this  simulation. 

The  gain  values  used  in  the  tracking  simulation  are  approximately 
those  obtained  by  a simple  gradient  parameter  search  [27]  to  minimize 
the  sun  of  the  squares  of  the  tracking  errors  in  each  channel. 

Various  test  curvature  control-profile  functions  were  used  as  input 
signals  to  the  tracker  system  in  the  process  of  adjusting  the  gains. 
The  resulting  gains  are  only  appropriate  for  the  particular  aircraft 
system  that  is  simulated  here. 

For  two  sets  of  gains,  Table  7-1  lists  the  performance  data  for 
tracking  an  optimal  path  with  a fairly  oscillatory  control  curvature. 
The  path  is  the  one  sliown  in  Figure  6-9  with  the  1000- ft  control 
interval  (Framing  Structure  14  of  Table  6-3).  The  first  set  of 
gains  was  chosen  after  a few  trials  based  on  the  estimates  of  what 
would  be  appropriate  if  the  aircraft  bcliaved  as  a third  order  linear 
system.  The  second  set  is  the  result  of  the  gradient  search  optimiza- 
tion that  started  from  Set  1 values.  Although  the  improvement  in 
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Table  7-1  Tracker  Cains  § Performance 
(Based  on  241  Sample  Points  at  200  ft  Intervals) 


TRACKING  ERRORS: 


( max 
ah  < min 


( max 
as  (min 

[rms 

{max 
min 
RMS 


♦18.34  ft 
-19.08 
9.21 


+11.46  ft 
-11.70 
6.  SO 


+.02649  (+1.5°)  +.01268  (+0.7°) 

-.02828  (-1.6°)  -.011S1  (-0.6°) 

.01143  ( 0.6°)  .00535  ( 0.3*) 

+.9782xl0"4ft'1(2.45  G)  +.2053xl0'4ft'1(0. 51  G) 
-.6932  (-1.75  G)  -.2409  (-0.60  G) 

.1877  (0.46  G)  .0800  (0.20  G) 


ACCELERATIONS; 

Optirai 
Path  Values 

(max 

a.,  (min 

1 (Ki'ii) 

+2.00  G's 
-1.00 

+2.11  G’s 
-1.49 


+1,94  G’s 
-1.08 


performance  obtained  by  the  tracking  optimization  is  not  large,  it 
is  significant  enough  to  add  confidence  in  the  use  of  the  improved 
gain  set. 

The  performance  using  Gain  Set  2 for  a variety  of  optimal- 
trajectory  inputs  is  illustrated  by  the  remaining  figures  in  this 
chapter  and  the  data  are  summarized  in  Table  7-2.  Shown  in  each  figure 
are  four  plots:  first,  the  altitude  or  height  error,  then  three  com- 

parisons of  the  optimal  and  aircraft  path  data--the  heights,  slopes, 
and  curvatures.  These  plots  indicate  the  error  behavior  in  each  of 
the  three  tracking  diannels.  A soft-ride  trajectory  is  shown  in 
Figure  7-3,  while  Figures  7-4,  7-5  and  7-6  show  hard-ride  runs  with 
basic  control  intervals  of  2000,  1000  and  500  feet,  respectively. 

These  runs  use  framing  Structures  11,  13,  14  and  15  (Table  6-3). 

In  Table  7-2,  the  minimum  height  error  appears  insensitive  to 
variations  in  the  jerk  limits.  However,  the  maximum  and  RMS  height 
errors  show  a trend  toward  increasing  errors  with  increasing  jerk. 

The  run  with  the  finest  control -point  spacing  appears  to  be  an  excep- 
tion to  this  trend,  but  it  is  based  on  fewer  sample  points  over  a 
portion  of  the  terrain  that  appears  to  cause  smaller  tricking  errors, 
as  can  be  observed  from  Figures  7-3  through  7-6.  All  other  tracking 
errors  follow  the  same  trend.  Furthermore,  vehicle  fuel  economy 
and  pilot  ride  comfort  vary  inversely  with  jerk  and  RMS  acceleration, 
rherefore,  it  is  desirable  to  keep  the  jerk  and  acceleration  as  low 
as  possible,  but  restriction  of  this  maneuvering  capability  also 
increases  the  RMS  excess  clearance  for  the  flight,  as  indicated  by 


Table  7-2  Tracker  Performance  Data 


Based  or.  91  Sample  Points. 


Ill 


the  values  listed  for  the  reference  path  in  the  table.  Sane  compromise 
between  the  two  effects  is  required. 

The  accelerations  given  in  Table  7-2  are  those  measured  at  the 
pilots  station.  Since  the  pitch  rates  are  small,  there  is  little 
difference  between  those  and  the  normal  accelerations  at  the  aircraft 
center-of-gravity.  The  objectives  for  this  controller  are  to  control 
very  closely  the  extremes  of  the  normal  acceleration  and  the  terrain 
clearance.  The  simulation  results  presented  here  indicate  that  this 
is  done  extremely  well. 


8.  REAL  TIME  AIRBORNE  APPLICATIONS 

The  overlapping  frame  process  described  in  Chapter  4 was 
designed  for  real  time  airborne  application,  as  illustrated  in 
Figure  8-1.  Three  successive  overlapping  frames  of  terrain  data 


Figure  8-1  Real  Time  Framing 

are  depicted  in  the  figure  for  a particular  time,  t.  The  time  inter- 
val allowed  for  the  optimization  processing  of  one  frame  is  at. 

Frame  1 contains  information  that  is  based  on  terrain  data  that  was 
input  to  the  system  two  time  intervals  earlier,  at  t-2at.  The  path 
optimizer  began  processing  this  terrain  information  one  time  interval 
earlier,  at  t-at.  The  optimal  path  solution  that  was  computed  is 
currently  being  used  in  the  tracker  system  for  guidance  of  the  air- 
craft. Also,  at  time  t,  the  Frame- 2 terrain  data  is  being  processed 
by  the  optimization  routine;  it  was  input  to  the  system  one  time 
interval  earlier,  at  t-at.  The  terrain  data  in  Frame  3 is  currently 
being  input  and  stored  in  the  processing  system.  The  terrain  data  can 
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be  provided  by  a forward-looking  radar,  or  it  can  be  obtained  from 
stored  terrain  map  data  if  the  aircraft  position  relative  to  the 
map  is  known. 

During  the  time  corresponding  to  each  of  the  frame  advance  inter- 
vals, a complete  optimization  problem  is  solved,  and  a new  set  of 
terrain  data  is  stored.  These  two  distinct  information  processes  can 
be  done  simultaneously,  or  on  a time-shared  basis,  depending  upon 
the  processor  structure  available.  The  assumption  that  separate 
processors  are  available  for  the  two  tasks  is  made  here.  The  process 
with  the  longer  duration  {probably  the  optimization)  determines  the 
maximum  frame  advance  distance  that  can  be  used  in  real  time. 

If  computation  time  were  not  a factor,  computational  errors 
could  be  maintained  at  a negligible  level  compared  to  the  errors 
introduced  into  the  system  by  the  terrain  and  navigational  sensors. 
However,  in  real  time  applications,  the  computational  time  is  severely 
restricted,  and  the  particular  framing  structure  is  the  key  to  com- 
putational time  and  computational  accuracy.  There  generally  must  be 
a trade  off  between  computational  time  and  accuracy.  The  framing 
structure  described  in  Section  4.6  allows  a great  variety  of  combina- 
tions and  trade  offs.  As  previous  results  indicate,  the  computational 
time  increases  extremely  rapidly  with  the  increase  in  the  dimension  of 
the  optimization  problem.  Since  the  performance  is  measured  and  the 
constraints  are  enforced  at  various  sample  points,  the  dimension  of 
the  problem  is  determined  by  the  number  of  sample  points,  which 
depends  upon  both  the  frame  length  and  various  sample  intervals.  It 
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[ is  desirable  to  reduce  the  number  of  sample  points  as  much  as  possible, 

i 

to  minimize  both  the  computational  time  and  storage.  The  factors 

< 

i 

involved  in  this  reduction  are  discussed  below. 

8.1  Total  Number  of  Sample  Points 

From  the  various  parametric  studies  discussed  in  previous  chapters, 
the  following  conclusions  can  be  drawn  with  respect  to  reducing  the 
total  number  of  sample  points: 

1)  Slope  constraints  should  not  be  applied  unless  there  is  a 
strong  reason  for  limiting  the  flight  path  angle.  Many  flat  and 
moderate  terrains  will  not  require  slope  limits,  because  the  limits 
would  not  be  normally  encountered.  If  required,  they  can  be  sampled 
more  coarsely  than  the  clearance  constraints,  since  the  slope  changes 
are  more  gradual. 

2)  The  min-max  criterion  requires  more  constraints,  in  the  form 
of  upper  bounds  on  the  clearance  distance,  and  should  not  generally  be 
applied. 

3)  The  linear  programing  problem  may  not  require  as  large  an 
optimization  problem  as  the  quadratic  programing  problem,  so  the 
linear  performance  criteria  is  recommended.  Theoretically,  the 
solution  may  not  l>e  unique  for  this  problem- -there  may  be  more  than 
one  set  of  control  points  tliat  give  the  same  optimal  performance 
measure,  but  any  of  these  would  be  acceptable,  or  equally  "close"  to 
the  terrain.  Therefore,  no  effort  is  made  to  study  non-uniqueness 

i here. 

I 

i 

4)  The  spacing  of  the  clearance  constraint  points  must  be  as 

j fine  as  the  finest  control  point  spacing  to  prevent  constraint 


j 
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violations  between  constraint  points  from  becoming  significant.  A 
similar  argument  can  be  given  in  regard  to  clearance  constraint  point 
spacing  vs.  terrain  point  spacing.  The  terrain  and  clearance  curve 
intervals  are  assuned  to  be  equal,  and  if  the  clearance-constraint 
interval  is  not  at  least  as  fine  as  the  sample  interval  of  the 
clearance  curve,  more  extreme  curvatures  of  the  clearance  curve  can 
create  significant  violations  between  constraint  points.  The  maximum 
constraint  violation  that  can  occur  between  sample  points  is 
approximately 

cv*^Ak(AR)2  (8-1) 

where  Ak  is  the  difference  in  curvature  between  the  two  curves  being 
considered,  and  AR  is  the  constraint  range  interval.  (The  approxima- 
tion is  derived  in  Appendix  II,  based  on  constant  curvature  for  each 
curve  over  the  interval  of  violation). 

5)  Trade  offs  between  ride-softness  and  specified  minimum- 
clearance  distance  may  be  required  to  keep  the  problem  dimension  down. 

i 
! 

The  more  restrictive  curvature  limits  of  the  softer  ride  require  a 
longer  frame  length  to  predict  clearance  of  the  same  height  obstacle. 
Longer  frames  generally  require  more  sample  points  of  all  kinds -- 
unless  the  sample  intervals  are  increased.  But  increasing  the 
interval  length  increases  the  likelihood  of  constraint  violations 
between  sample  points.  A small  percentage  of  violation  will  be  much 
more  acceptable  for  a high  clearance  trajectory  than  for  a low 
clearance  trajectory. 


i 

r 


6)  The  feasibility  of  a real  tine  schene  is  dependent  upon  the 
aircraft  performance:  the  speed,  acceleration  and  slope  limits.  For 
example,  a missile  flying  at  Mach  2.5  at  sea  level  (2792  fps)  with 
acceleration  limits  of  -1  and  +3  G's  would  require  curvature  limits 
of  +.000012  and  -.000004  ft'*.  This  would  correspond  to  a charac- 
teristic frame  length  estimate  of  S4,900  feet  (for  the  1000  ft 
obstacle  used  previously) . This  long  frame  length  would  require  a 
high  dimensional  optimization  problem  for  realistic  sample  point 
intervals  (probably  about  500  ft  for  the  terrain  and  clearance  data). 
However,  if  the  acceleration  limits  are  changed  to  -5  and  +15  G's, 
with  all  other  data  the  same,  the  new  estimate  for  frame  length  would 
be  only  24,600  feet  since  the  vehicle  would  be  nuch  more  maneuverable. 
8.2  Computational  Requirements 

Same  conclusions  can  be  drawn  from  the  computational  requirements 
of  the  test  programs  run  on  the  CDC  6600  computer,  but  it  is  extremely 
difficult  to  compare  these  results  directly  with  airborne  computer 
requirements  for  the  following  reasons: 

1)  The  test  program  has  many  optional  features  used  in  the  para- 
metric studies  that  would  probably  not  be  included  in  an  operational 
program.  Also,  precomputation  of  many  of  the  matrices  used  prior  to 
flight  could  reduce  significantly  the  inflight  computation. 

2)  A direct  linear  programming  algorithm  would  probably  be  used 
rather  than  the  complementary  problem,  which  requires  more  storage 
and  probably  more  time. 

3)  The  word  length  and  processor  structure  of  the  airborne 
computer  would  be  different,  so  equivalent  programs  might  run  at 
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different  speeds  on  the  two  computers. 

4)  Input  and  output  devices  would  be  significantly  different 
for  the  two  computer  systems.  This  would  have  a significant  effect 
on  the  computational  times.  However,  the  use  of  central  processor 
times  tends  to  minimize  this  effect. 

With  the  first  two  items  above  tending  to  offset  any  increases 
in  the  requirements  due  to  the  second  two,  the  CDC  6600  execution 
times  are  some  indication  of  the  feasibility  of  this  optimal-path- 
spline  terrain-following  scheme. 

8.3  Evaluation  of  the  Framing  Structure  for  an  Exairple  Missile 

It  is  difficult  to  draw  any  conclusions  about  the  real  time 
feasibility  of  the  optimal-path  scheme  unless  a particular  frame 
structure  is  specified.  The  most  rigorous  test  of  the  scheme  is  an 
extremely  high  speed  vehicle,  since  the  system  must  process  the 
terrain  data  most  rapidly.  Therefore,  the  case  of  a very  high- 
speed missile  is  considered,  with  a few  variations  in  the  framing 
structure.  If  the  real  time  scheme  is  feasible  for  this  missile  it 
should  certainly  be  feasible  for  slower  vehicles.  The  test  missile 
is  the  example  mentioned  in  Section  8.1  and  travels  at  Mach  2.5.  The 
most  difficult  framing  structure  for  processing  corresponds  to  very 
restricted  maneuverability  of  the  missile,  such  as,  soft-ride  acceler- 
ation limits  of  -1  and  +3  G's.  Since  the  optimization  problem  must 
be  limited,  a frame  length  slightly  shorter  than  the  characteristic 
length  of  54,900  feet  is  selected.  A 2000-ft  control  interval  is 
used,  which  is  considerably  longer  than  the  characteristic  interval 
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of  324  feet.  Even  with  the  longer  control  interval,  the  50, 000- ft  frame 
length,  with  25  equally  spaced  control  points  and  50-point  clearance 
constraints,  produces  a complementary  problem  of  dimension  100.  The 
complete  set  of  framing  parameters  is  listed  in  Table  8-1  as 
Structure  18.  The  corresponding  optimal  path  and  curvature  are  shown 
in  Figure  8-2.  .The  performance  appears  to  be  good  despite  the 
restrictions  placed  on  the  framing  structure  and  maneuverability.  The 
computational  times  and  performance  data  for  the  run  are  listed  in 
Table  8-2.  The  "allowable”  frame  time  is  that  which  is  required  for 
the  optimization  processing  to  handle  the  terrain  data  as  rapidly  as 
the  vehicle  traverses  the  terrain.  It  is  computed  by  dividing  the 
frame  advance  distance  by  the  nominal  vehicle  speed. 

The  RMS  and  max  mm  excess  clearance  values  in  the  table  for 
Structure  18  are  rather  high  because  of  the  acceleration  limits. 
Therefore,  the  more  maneuverable  cases  of  Structures  19  and  20  are 
considered.  The  framing  structures  are  listed  in  Table  8-1,  while 
the  performance  data  is  in  Table  8-2.  The  RMS  and  maximum  excess 
clearance  values  are  reduced  substantially  for  both  of  the  more 
maneuverable  cases.  The  slightly  longer  frame  length  of  Structure  19 
shows  an  improvement  in  excess  clearance  over  that  for  Structure  20; 
this  can  also  be  seen  in  the  plot  of  the  paths  shown  in  Figure  8-3. 
However,  the  shorter  advance  distance  for  Structure  19  is  borderline 
for  real  time  application.  The  first  frame  takes  slightly  more  com- 
putational time  than  the  allowable  frame  time.  The  first  frame 
always  requires  more  time  than  the  others  during  a run,  because  of 
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Table  3-1  Framing  Structures  for  Missile  Paths 


Structure  Number 

Dim. 

18 

19 

20 

21 

Type  of  Terrain 

Moderately  Rough 
oT-  364  ft 

Smooth 
<jt-137  ft 

Type  of  Ride 

Soft 

Hard 

Expected  Obstacle  lit. 

ft 

1000 

500 

Charact.  Frame  Length 

K-ft 

54.9 

24.6 

24.6 

17.4 

Frame  Length 

K-ft 

50 

26 

24 

24 

Frame  Advance 

K-ft 

24 

14 

16 

12 

LIMITS: 

mam 

■m 

■K 

mm ■ 

Curvature 

El 

wsm 

♦.6 

-.2 

n 

Acceleration* 

G's 

mm 

mm 

BB 

mom 

WSM 

U 

II 

nfl 

Kink** 

gggg | 

±.80 

±3.0 

±8.0 

±4.0 

Jerk* 

G’s/ sec 

±5.4 

±54.1 

BW 

±27.0 

Nr.  of  Control  Pts. 

25 

26 

24 

12 

Complem.  Prob.  Dim. 

100 

78 

72 

36 

SAMPLE  INTERVALS: 

Characteristic 

.324 

1.444 

1.444 

1.022 

Curvature 

i 2 

1 

1 

2 

Perform tance  Meas. 

h 

1 

1 

2 

Clearance  Const. 

i 

1 

1 

2 

Terrain  Data 

: 2 

i 

2 

2 

2 

PERFORMANCE  COEFFS: 

CL 

0 

W y_ 

CQ 

Si 

.i 

.1 

.i 

.i 

0 

0 

0 

0 

Figure  Number 

8-2 

8-3 

8-3 

8-4 

* For  V 3 2792  fps 

**  Inherent  limits  from  A,  and 


Figure  8-2  Example  Missile  Optimal  Path  for  Scft-Ride 
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Table  8-2  Missile  Reference  Path  Performance  8 Computational  Times 


Structure  Number 

18 

19 

20 

21 

Type  of  Terrain 

Moderately  Rough 

Smooth 

Type  of  Ride 

Soft 

Hard 

Frame  Length  (K-ft) 

50 

26 

24 

24 

Frame  Advance  (K-ft] 

24 

14 

16 

12 

Complem.  Problem  Dim. 

100 

78 

72 

36 

Allowable  Frame  Time  (si 

ec)  8.6 

5.0 

5.7 

4.3 

COMPUTATIONAL  TIMES: 

(Per  Frame] 

■■ 

Max 

6.3 

5.5 

4.5 

■S3 

Min  (sec) 

1.3 

3.4 

2.4 

« 9 

Average 

3.8 

4.3 

■ 

3.2 

0. 53 

Number  of  Frames 

2 

4 

4 

27 

EXCESS  CLEARANCE 

(For  321  Sample  Points  at 

,226  Pts.  i 

HEiarrs: 

4 - 200  ft) 

'•4*1200  ftJ. 

cmax 

664 

mm 

384 

52 

cmin  (ft) 

-7 

mm 

-8 

-6 

eRMS 

292 

■ 

121 

9 

Figure  Number 

8-2 

8-3 

8-3 

8-4 

the  initialization  of  some  of  the  matrices  in  the  computer  routine 
used.  There  is  no  reason  that  the  matrices  could  not  be  initialized 
in  flight  prior  to  real  time  operation,  to  overcome  this  problem. 

! 

j The  short  time  for  the  second  frame  of  Structure  18  appears  to 

( 

| , be  just  very  fortuitous,  as  can  be  seen  by  comparison  with  the 

* minimum  times  of  the  smaller  dimensional  problems.  One  more  framing 

| 

j 

% 

? 

i 


Figure  8-3  Example  Missile  Optimal  Path  for  Hard-Ride 
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structure  is  considered  for  a flight  over  a different  terrain  segment. 
This  second  terrain  is  classified  as  smooth  terrain,  since  it  has  a 
standard  deviation  of  - 137  feet  (compared  to  the  * 364  feet 
of  the  previous  terrain) . Structure  21  of  Table  8-1  is  used  in  an 
effort  to  reduce  the  problem  dimension  without  sacrificing  performance. 
Both  the  frame  length  and  the  control  interval  selected  are  considerably 
greater  than  the  corresponding  characteristic  values.  The  net  result 
is  a reduction  by  a factor  of  one-half  in  the  complementary  problem 
dimension,  while  the  computational  time  reduction  is  considerably  more 
than  one-half,  as  indicated  in  Table  8-2.  The  performance  over  the 
smooth  terrain  is  excellent,  as  illustrated  in  Figure  8-4,  where  the 
optimal  path  does  not  differ  essentially  from  the  minimal-clearance 
curve  except  in  a few  short  regions.  The  expected  obstacle  heights 
are  based  on  approximate  peak  heights  of  the  terrain  segments,  but 
II  values  of  3o^,  would  be  fairly  good  estimates,  as  can  be  observed 
from  the  values  in  Table  8-1. 

Although  some  sacrifice  in  following  the  terrain  closely  may  be 
required  in  some  missions,  the  path  optimization  scheme  appears  to  be 
quite  feasible  and  flexible  for  real  time  applications. 


9.  CONCLUSIONS  AND  RECOMMENDATIONS 

The  concept  of  including  an  optimal  path  determination  scheme 
into  a terrain  follower  appears  to  be  quite  feasible  in  a modem, 
computer-equipped  aircraft.  It  also  offers  a good  deal  of  flexi- 
bility as  a progranmable  control  system.  These  conclusions  are 
based  on  the  following  discussions  of  the  various  facets  of  the 
problem. 

9.1  Splines  and  Clearance  Paths 

Although  it  is  possible  to  treat  both  the  terrain  data  and 
reference  clearance  path  data  as  sets  of  discrete  points,  computa- 
tional flexibility  and  more  realistic  path  representations  can  be 
obtained  through  the  use  of  cubic  splines.  The  computation  sample 
interval  need  not  be  restricted  to  the  terrain  data  intervals  if 
splines  are  used  for  interpolation  between  data  points.  The 
amount  of  computation  required  to  interpolate  between  data  points 
is  a very  small  pa.-t  of  the  overall  computational  requirements. 
Interpolation  between  data  points  also  provides  a basis  for  calcula- 
tion of  slant-clearance-distance  paths,  for  which  the  nearest 
distance  between  the  clearance  and  terrain  curves  is  equal  to  the 
specified  clearance  value.  This  calculation  gives  a more  accurate 
clearance  than  measuring  a clearance  path  with  the  vertical 
distance  equal  to  the  specified  clearance  value;  however,  the  slant 
procedure  is  more  precise  than  usually  needed.  It  was  found  that 
for  typical  terrain  segments  a simple  estimate  of  points  on  the 
slant  clearance  path  provided  a good  reference  clearance  path. 
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The  estimate  at  any  point  is  based  on  the  local  height,  slope,  and 
curvature  of  the  terrain-spline  curve. 

9 . 2 Optimal  Path  Computations 

The  computation  of  the  optimal  path  by  either  quadratic  or 
linear  programming  algorithms  is  far  superior  to  general  optimiza- 
tion algorithms  using  penalty  functions,  primarily  on  the  basis  of 
computational  time.  The  solution  trajectories  themselves  agree 
fairly  well,  but  the  penalty  function  solutions  have  clearance 
constraint  violations  near  terrain  peaks.  Although  three  types  of 
performance  criteria  were  analyzed:  linear,  quadratic,  and  min-max; 

the  trajectories  tend  to  be  very  constraint  bound  and  rather  insen- 
sitive to  the  particular  performance  measure.  Piecing  various 
constrained  arcs  together  with  appropriate  transition  arcs  is  the 
primary  task  of  the  optimization  routine.  If  the  programming 
problems  were  always  feasible,  the  simplest  performance  criterion 
would  be  the  most  appropriate;  the  linear  criterion  and  its 
resulting  linear  programming  problem  might  have  smaller  computational 
requirements  than  the  other  performance  measures.  A revised 
simplex  algorithm  [ 1 d J would  be  a candidate  for  solving  the  linear 
problem,  but  Shankland's  algorithm  [29]  which  handles  infeasibilities 
in  the  quadratic  programming  problem  appears  to  be  the  most  promis- 
ing algorithm  considered. 

'Hie  data  frame  length  must  be  chosen  to  gi^e  adequate  predictive 
capability  to  the  scheme.  The  frame  length  derived,  from  the 
Characteristic  Maneuver,  which  is  nased  on  a specif ied-obstacle- 
height.  and  the  aircraft  acceleration  limits,  is  a good  estimate  of 
"ideal"  frame  length  for  all  of  the  cases  considered  here. 
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A great  flexibility  is  possible  in  the  selection  of  control 
point  spacings  and  the  various  sample  intervals  used  for  performance 
measure  and  constraint  satisfaction.  Larger  intervals  yield  smaller 
computational  requirements,  both  in  time  and  memory  storage,  but  this 
is  at  the  cost  of  theoretical  optimal  performance  and  accuracy.  The 
control  function  suffers  from  lack  of  flexibility  if  the  control 
point  spacing  is  large,  and  the  corresponding  trajectory  will  have 
a higher  RMS  clearance  value  than  would  one  with  finer  control -point 
spacing.  However,  if  the  control  points  are  too  closely  spaced, 
ride  comfort  for  the  pilot  will  decrease,  while  tracking  errors  and 
fuel  consumption  will  increase  as  the  aircraft  attempts  to  follow 
the  computed  optimal  path.  Also,  greater  overshoots  of  the  desired 
acceleration  limits  will  occur,  along  with  the  path  overshoots. 

The  number  of  control  points  and,  hence,  the  computational  require- 
ments, can  be  reduced  through  a graduated  control  point  spacing, 
where  the  near- frame  (close  to  the  aircraft)  spacing  is  fine  for 
control  flexibility  and  the  far  frame  spacing  is  coarse  to  predict 
gross  positional  changes  that  may  be  required.  The  final  deter- 
mination would  depend  upon  the  [’articular  mission  considered. 

!>.3  Tracker  System  Performance 

The  validation  of  the  optimal  path  scheme  required  a realistic 
aircraft  simulation  and  a candidate  tracker  system  model.  Since 
the  optimal  path  was  designed  to  provide  a "trackable"  path,  an 
optimal  tracker  system  was  not  considered  necessary,  rather,  a 
simple  feedback  tracker  system  was  tested.  The  tracker  used  inertial 


128 


path  information  plus  two  derivatives  that  were  available  from  the 
optimal  path  solutions  of  data  frames  with  appropriate  framing 
structure.  The  tracker  performed  extremely  well,  with  approximately  a 
6- ft  SMS  tracking  error  and  a maxim—  tracking  error  of  12  feet, 
over  a moderately  rough  terrain  under  hard-ride  conditions 
(-1,  *2  G’s).  This  corresponded  to  errors  of  less  than  121  of 
the  specified  mininun-clearance  of  100  feet. 

!).4  Overall  System  Performance 

The  overall  performance  of  the  system  depends  primarily  upon 
how  accurately  the  terrain  data  and  the  aircraft's  position  relative 
to  the  terrain  can  be  determined.  The  choice  of  framing  structure 
affects  the  sense  of  optimality  in  determining  the  optimal  reference 
trajectory.  A variety  of  possible  trade  offs  are  possible  in  an 
operational  system- -trade  offs  between  closeness  to  the  terrain  and 
computational  requirements.  Performance  can  be  adjusted,  depending 
upon  the  particular  aircraft  and  mission,  by  changing  parameter 
values  in  the  digital  computer.  Thus,  the  system  is  very  flexible. 

The  overall  system  was  compared  to  that  of  Greaves  [11], 
since  that  system  is  the  most  advanced  to  date.  All  of  the 
approaches  discussed  by  Greaves  corapate  slopes  and  accelerations  of 
the  "ideal"  paths  using  difference  equations.  These  correspond  to 
parabolic  path  segments  that  will  not  necessarily  be  joined  in  a 
desirable  way;  i.e.,  they  will  not  form  a quadratic  spline  and  they 
nay  be  disjoint.  (Whereas,  the  cubic  spline  approach  produces 
slopes  and  accelerations  for  a smooth  continuous  path).  Therefore, 


129 


i 

' ( the  Greaves  path  may  not  be  one  that  the  aircraft  can  fly,  and  the 

f system  would  require  a very  good  (optimal)  tracking  system.  Further- 

p 

l * more,  the  acceleration  profiles  of  the  optimal  paths  with  the 

Greaves'  method  tend  to  be  more  bang-gang  in  character,  since  there 
are  no  transition  arcs  between  maximum  pullup  and  pushover  arcs. 

This  also  makes  his  "ideal"  path  more  difficult  to  track.  The 
additional  structure  of  the  optimal  spline  paths  provides  sufficient 
predictive  information  for  a very  simple  feedback  tracker  system, 
which  can  be  optimized  by  gain  selection  for  a truly  nonlinear  air- 
craft system,  rather  than  through  tl>e  use  of  linear  approximations. 

The  sense  of  optimality  of  the  two  systems  differs  somewhat: 
the  sense  of  Greaves  system  is  rather  obscure  although  it  emphasizes 
the  clearances  near  high  terrain  areas,  while  the  spline-path 

j system  minimizes  a weighted  average  clearance  measure,  where  the 

i 

| weights  can  be  directly  adjusted  in  the  computer  program.  Both 

! systems  have  a tendency  to  make  paths  nearly  horizontal  at  the 

1 I 

peaks,  but  no  strong  reason  for  requiring  it  was  observed.  Con- 
ceptually, it  is  possible  to  add  that  constraint  to  either  system, 
if  necessary. 

| Although  the  system  proposed  by  Greaves  appears  to  be  somewhat 

simpler  in  path  processing,  it  is  more  complex  in  the  tracking 
system.  The  approach  of  the  optimal -spline-path  system  is  a more 
unified  approach  for  the  overall  system. 

9.5  Recotrmendations 

* 1)  further  studies  of  the  optimal -spline- path  terrain  following 

system  should  be  made  to  select  the  best  programming  algorithm. 

I 
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These  studies  might  also  include  the  effects  of  radar  shadowing, 
in  which  the  terrain  data  that  is  input  to  the  optimization  processor 
is  limited  to  that  available  on  a direct  line  of  sight.  The 
optimization  algorithm  does  not  change,  but  the  data  that  it  must 
use  is  modified  from  the  true  terrain  values.  Thus,  the  probability 
of  infeasible  programming  problems  increases. 

2)  The  optimal  path  generator  can  be  used  as  a design  aid  to 
provide  rapid  generation  of  standard  reference  trajectories  for  any 
desired  terrain  segment.  These  standards  can  be  used  to  evaluate 
proposed  controllers  and  modifications  to  those  controllers. 

3)  The  optimal  reference  trajectories  can  be  used  for  frequency 
analysis  to  determine  what  frequency  spectra  the  flight  control 
system  must  be  capable  of  handling  during  terrain  following.  The 
path  optimization  processor  acts  as  a low-pass  filter  to  attenuate 
the  amplitudes  of  any  high  frequency  terrain  components.  The 
frequency  spectnan  of  the  processed  path  is  what  the  flight  control 
system  must  be  capable  of  handling.  The  framing  structure  used  in 
determining  the  reference  path  will  affect  the  frequency  content  of 
the  path.  The  characteristics  of  an  existing  flight -control  system 
can  be  used  to  determine  a compatible  frame  structure  for  the 
terrain  following  controller,  or  from  desired  flight  profiles,  the 
framing  structure  and  corresponding  flight -control  system  require- 
ments can  be  developed. 

4}  The  concepts  of  the  optimal -path  follower  can  be  extended 
to  terrain  avoidance.  If  only  lateral  motion  is  involved  in  the 
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terrain  avoidance  mode  (with  an  altitude  hold) , the  extension 
merely  involves  a transfer  of  the  problem  from  the  vertical  plane 
to  a horizontal  plane.  The  performance  measure  would  be  referenced 
to  a navigation  path,  valley,  or  ridge  line  that  the  vehicle  is 
attempting  to  follow.  If  a combination  of  terrain-avoidance  and 
terrain- following  is  desired,  the  optimization  problem  will,  at 
least,  double  in  size.  Furthermore,  linearization  of  the  coupling 
effects  between  lateral  and  vertical  motion  relative  to  the 
terrain  must  be  employed. 

5)  The  spline -tracker  concept  discussed  in  Chapter  7 has 
broader  applications  than  merely  to  that  of  an  optimal-path  follower. 
A reference  spline  path  can  be  generated  in  a great  variety  of 
ways.  For  example,  the  spline  path  could  be  a navigation  tTack  pass- 
ing through  specified  "way  points.”  In  that  case,  the  lateral  flight 
control  system  would  track  the  navigation  path,  which  would  be 
defined  by  a fairly  small  set  of  discrete  values,  and  yet  represent 
a very  smooth  path.  A great  variety  of  maneuvers  coull  be  accom- 
plished in  a similar  manner  by  merely  specifying  certain  points 
on  a three-dimensional  path  as  guidance  parameters.  The  control 
system  would  then  track  a hi -variant  spline  fit  through  the  points. 
Techniques  of  this  typo  would  be  quite  useful  in  digital  conmand- 
guidance  systems. 


APPENDIX  A 


OPTIMIZATION  PROBLIM  EQUATION  DERIVATIONS 

The  first  part  of  this  Appendix  contains  a derivation  of  the 
equations  for  the  path  state  variables  as  affine  functions  of  the 
curvature-control-point  values.  Then,  the  cost  gradients  with  res- 
pect to  the  control -point  values  are  derived.  (The  gradients  are 
used  only  in  the  general  optimization  routine.)  From  the  path  state 
relationships,  the  equations  for  the  quadratic  programming  problem 
and  the  corresponding  complementary  problem  are  derived. 

A.l  Path  State  Equations 

The  path  state  variaoles , as  described  by  differential  equations, 

are  the  path  height  h and  the  slope  s,  while  the  independent 

variable  is  range  R,  and  the  control  function  is  the  curvature  k. 

The  h,  s,  and  k variables  for  the  cubic  spline  path  are  functions  of 

the  set  of  discrete  control  values  k . 

n 

h,(R;kn)  5 ^ (R;^)  = sCR;^)  (A-l) 

s’(R;kn)  = gf  (R;kn)  = (A- 2) 


k(R;kn)  = (l-cOkj  + aki+1  = ^ + o(ki+1  - k.) 


(A- 3) 


for  Re  [R^,  , where  the  "normalized"  range  increment  is 


R-Ri 


Ri+rRi 


(A- 4) 


over  the  control  interval 


A.  s R.  , -R. 
i i+l  l 


(A-5) 
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The  kink,  p,  can  also  be  considered  as  a state  variable,  but  it  is 

defined  directly  as  a function  of  the  control  set  k . 

n 

p = ]—  (k.  , -k. ) (A-6) 

1 l A . 1+1  1 

1 

One  can  convert  the  two  differential  equation  relationships  into 
simple  functions  of  the  k by  integration.  Note  that  on  the  hori- 


zontal range  interval  A^ , 


do  = i-  JR 
A . 

1 


(A- 7) 


When  hq.  (A-3)  is  substituted  into  12q.  (A-2)  and  the  resulting 
equation  is  integrated  over  the  normalized  interval  f0,o],  in  terms 
oi  the  dummy  variable  z,  the  result  is 


s[R)  s(Ri)  + Aj  Jjj  fkj  + z(ki+1-ki) ] dz 


- *0^)  ■*  [k-n+  j Akjo* 


where 


Aki  " ki+l'ki 


At  the  end  of  tlic  control  interval,  where  o=l, 

A. 

sCd,+1)  = s(R.)  + ~(k,+kxl) 

-I  d . i-  J J • u 


(A-8) 


(A-9) 


(A-101 


Hccursivc  use  of  this  equation  for  i=0,  1,  2,  n yields 

sag  = so<())  + \ y-  (Vki+P 

l-O 


(A- 11) 


Thus  for  !'1  lKn.,’n+i1 


n-1 


s (!■)  = S(R(p  + j J.  Aj  (kj+ki  + j)  + Ajjk.o+  \ Ak^2] 
i -0 


(A- 12) 
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Similarly,  the  height  equation  can  be  integrated  using  Eq.  (A-8) 

h(R)  - hCR^  + ^ [s(Ri)  + Ai(kiz+  \ Ak.z2)]dz 

A.2  7 A,2  , 

= h(R^)  + A^sCR^o  + -^-k^o  + ~~?T^ia 


(A-13) 


and  for  the  full  interval  (o=l) 


A, 


h(Ri+i)  = hCR^  ♦ A^)  + -^-(2ki+ki+1) 

When  Iqs.  (A- 14)  and  (A-10)  are  used  recursively,  for  i=0,  1, 
2 , • ■ • , n, 

n-1  ^ m-1 

h(kn)  - h(R„:  * E V5tV*  1 Z »1(Ki*ki*l)1 


1 n‘1  ? 

+ \ 1 A 2[2ki+ki+1] 

1-0 


' h(tV  * ( *<V  - "f’vi'V'W 


(A- 14) 


1 n_l  2 
1=0 


The  equation  for  RefR^R^^]  is  determined  from  Eqs.  (A-13), 
(A- 11)  and  (A-15) 


n-1 


n-1  m-1 


l,(R)  . MH0>  * ( >- Vs(lV  * 2 sn  *Vi<VW 

m=0  m=0  1=0 


1 n'1.  2 . 


n- 1 


(A-15) 


+ T>  .?;A  C2ki+ki*l?  + V°Va  + 2 .^Vi^+l)0 

1=0  i=0 


+ g-  Ai“l(3-o)k:i+ki+1o]o‘' 


(A- 16) 
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Finally,  the  excess  clearance  distance  at  R is  also  a function  of 
the  set  of  k^ 

e = eCR;^)  - hfRjk^  - c(R)  (A-17) 


Where  c is  the  minimun -clearance  curve  height. 

A. 2 Cost  Gradients 

'fhe  cost  function  is 
N 

■’  - J/Vn’  * >•„*„  * T rnc„2)*« 

n=l 


(A“18) 


where 


T = 


!1  if  e <0 
0 if  ej  >.  0 


(A- 19) 


and  Np  is  the  total  msnber  of  points  in  the  performance  sample  set. 

The  partial  derivative  of  en  with  respect  to  the  ith  control  point 
value,  k^,  is 


3en  3hh 

air'  wr 

A A 

The  cost  gradient  is 


(A- 20) 


3J 


^"n-l  3en  ^ 


*»_  >«  3hn 


(A-21) 


where 


3J 

3en 


(A- 2 2) 
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Wher  he  partial  derivatives  of  Eq.  (A- 15)  are  taken  with  respect  to 


the 


shj  Shf^.kp  , 

dk  dk . 

1 1 


i-1  3 

— J 0 


pfor  R^e [Rq ,R^ _ j) 

,for  V^i-l’V 


A • ^ A.  . A . - - 

"H(“Sr*o)  C~-^2c)+(l-o)aZj , 


,for  l5 


, A.  , (R  -Rj.,) 

1 r r i-l^ii  ti  *1  *•+! 


{(-T^*1K3 


“1TU~Z: 


Ai 


Ai_i 

* 2 ♦ 


,ior  V^VW  (A- 23) 


where  m > i+1 . 


A. 3 Quadratic  Programming  Pr oh  lew  Equations 

In  the  following  development,  two  distinct  types  of  indices 
will  be  used:  sample  point  superscripts  end  control  point  subscripts. 

The  sample  points  can  be  used  for  constraint  enforcement  as  well  as 
performance  measurement.  The  control  points  are  the  specific 
points  where  curvature  control  values  are  selected.  The  state  variable 
values  at  the  control  points  can  be  generated  recursively  by  Eqs. 
f A- 10)  and  (A- 14),  while  the  sample  point  values  are  determined 
iron  the  appropriate  control  point  values  by  Eqs.  QV-12)  and  (A-13). 

These  equations  lead  to  equations  of  the  following  forms. 

N, 


,u  . it,  , i 

Ji  = /.  u k • + y 

1-0  i 3 

n ..  , n,  n 

s - i-  f-  k3  f ,i 

i=0 


(A- 24) 
(A- 2 5) 


137 


h = I a .k.  ■*  Y 

m ._q  nu  1 'm 


s = r.  p .k.  + p 
m mi  1 n\ 


(A- 27) 


By  comparing  the  above  four  equations  with  Eqs,  (A-8)  and  (A- 13), 
one  can  obtain  recursive  relations  for  the  coefficients  that  are 
functions  only  of  incremental  range  from  the  last  control  point  at 
to  the  sanqple  point  at  Rn,  a11  = (Rn-Rm)/Am. 


, n-.  i 

n , n n . l,  fcj  J »■  f y n%  *.  . iif  i 

a.  = a . +A  a 6 . +A  ^ > [ (3  -a  ) 6 . +a  6,  , . . J 

i nu  m mi  m 6 mi  fm+li: 


(A- 28) 


n . . n 

v = v + A (J  n 

1 rni  m m 


(a-:p' 


C = B . ■*  A 
m 1 m:.  m 


f 2 ( Tl,  <- 

r f „n  ( O j r . ( ^ ) r-  "J 

1 T~  ^umiT  T~  °(m+l)iJ 


(m-3u  ) 


p = pm  = S0 


(A- 31) 


where  <5  is  the  Kronecker  delta: 


jo,  for  m f i 
mi  jjL,  for  m = i 


(A- 32) 


Now  the  inequality  constraint  equations  can  be  developed,  where 
the  zero  indices  indicate  specified  initial  condition  values. 


n -j  n ii  . Hi  , n n « 

C = h - C = h a.  k.+  unKn  *»*  y -c  >_0 

3=1  1 1 U 


(A- 33) 


v n,  n.  . n n 

• jfj  “i  V“)V'  -c 


(A- 34) 
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Also,  curvature  constraints  must  be  included: 


k. 

i 

< k >0 

— max 

, for 

(A- 35) 

k. 

> k . < 0 

, for  icii^ 

(A- 36) 

l 

— min 

lij.  is  the  index  set  oi'  the  control  points;  similarly  Hc,  H., 

r 

n]n,  and  ii  are  the  index  sets  of  the  sample  points  for  constraints 
on  minimum-clearance,  climb  slope,  dive,  and  maximum-clearance  (for 
min-rnax) , and  for  the  performance  measure,  respectively. 

In  terms  of  the  control  points,  the  climb  constraints  are 


S"  ' j'l  ki  * fi0T‘kO  * s0  - smax  ” 0 > for  m,s 


CA-37) 


and  the  dive  constraints  are 


s > s • <0 

- mm 


, foi  (A- 38) 


When  the  min -max  criterion  is  used,  the  following  additional  con- 
straints are  imposed,  where  m is  a parameter  value  to  be  determined 
by  the  optimization. 

e < m , for  neH  (A- 39) 

If  direct  kink  constraints  are  imposed,  they  are 

'min  -•  ’’n  — 'max  , for  ncii^  (A-40) 

'ihe  ct mat  ions  for  e,  s and  p can  be  written  in  the  following 
vector-matrix  form,  with  1:  an  N^-dimensional  vector, 

e = 1.1;  J 1-  (A- 41) 

s = Sk  W (A  -42) 

P = 1’k  (A- 4 3) 


seattuuMluti.  , ‘ifiarttaii.Wi’. vjob  Timrmtmim mean. aunt 
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whei^e,  lor  nrfl . , (i=p,c  or  m);  tci!.,  (j=s  or  d);  and  r,  qcHv 

T\ 

, an  x Nj,  matrix 


E.  = [a  “] 
i q 


S.  = [P  ] 
l 1 q J 

t-  n.  , n n 

*'i  = ao\  V ~C 
Ui  = f:0  k0 


, an  M.  x N,  matrix 
J K 


, an  IK  vector 


, an  Nj  vector 


(A-44) 

(A-45) 

(A-46) 

CA-47) 


P- 


Tfie  elements  of  1'  are 


, an  x Nj  matrix  (A-48) 


(■'(,.]  xrV  (A-«) 

The  following  combined  constraint  equation  (A-50)  can  be  expanded 
to  include  the  possibility  of  min-max  uppcr-bound-clearance 
constraints. 

C*  K < 1)  (A- 50) 

t:  is  an  (N,  + 1 ) x O’  + N + 4N,  + N + N,)  matrix  if  2NV  kink 
J;  m c in  K s d K 

constraints  are  enforced  arid  I)  is  an  (N  + N + 4N,  + N + N.) 

v c m k s d' 

vector.  In  partitioned  form  the  equation  is 


l -1 
m in 


-1, 


-S, 


-P 


I)  • 

0 
() 

0 i 

0 i 

0 
0 


K 

1 m J 


-i- 


m 


h 

V 

max 

-h 

k . 
min 

-h 

S . 
mm 

i 

S 

-s 

max 

h 

i) 

1 max 

h 

^inin 

‘d 

V 

s 


(A-51) 
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where  lm  = 1 if  Nm  f 0,  otherwise  lm  = 0;  and  1^  is  an  I*E  vector  with 

unit  elements,  while  is  an  indentity  matrix  of  dimension  N^. 

Similarly  the  j>erformance  function  can  be  written  in  matrix 

form,  where  ^ is  a diagonal  matrix  with  the  Qn  values  as  the  diagonal 

elements.  (If  all  the  are  equal  Q can  be  considered  a scalar). 

The  e and  U are  vectors  with  e„  and  L as  elements,  for  nelL  . 

n n P 

J = ^ e'Qe  + L'e  + m (A-52) 

Tne  form  of  Eq.  (A-41)  can  be  substituted  for  e into  Eq.  (A-52). 

J = i K'E'QEK  + [E'§  + I'lEK  + m + i-  F'QP  + L'F  (A-53) 

Ihe  last  two  terms  are  invariant  with  respect  to  the  parameters  K 

and  m,  so  the  set  of  K and  m values  that  minimize  J also  maximize  r. 

P = - \ K'E'QEK  - [F'Q‘+r»  ]EK  - m 

= - \ K'BK  + A'  - m (A- 54) 

where 


B = E'QE  (A- 55) 

A = -[E'$  + L']  (A- 56) 

A. 4 Complementary  Problem  Equations 

The  non-negativity  constraints  on  the  variables  in  the  Lemke 
formulation  of  the  complementary  problem  require  a "biased"  control 
parameter  set  of  the  form  in  Eq.  (A-57) 


x.  h k.  - k . > 0 

l i min  - 


leTi, 


(A-57) 


Thus,  the  excess  clearance  vector  for  the  performance  measure  sample 

set,  tl  , is  N dimensional: 

’ P P 


• V * r,,  ■ W * ’r 
■ ¥ * 'V 


(A- 58) 


b- 
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where 


D : E 1,  k . +1 

p p -k  min  p 


(A- 59) 


The  constraint  set  of  Liq.  (A- 35)  can  be  expressed  in  terms  of 
but  the  non-negativity  of  x replaces  the  lower-bound  constraint 
on  k. 


Ii  -1 
m m 


-H  0 
c 


*k  ° 


-Sj  0 


S_  0 


-P  0 


( Wmin  + V 
GcWoln  + Fc> 


(k  - k . )1. 
max  min 


(S ,1, k . + W,)-l.s 
d-k  min  d'  -d  n 

'(Ss^ckmin  + V h\ 
- Pwax  ' P*kkmin 
ikPmin  + 1ikkmin 


(A-60) 


which  can  be  written  in  the  form  of  Lq.  (A-61) 

<i  I l ) 1 H (A-61) 

Ibis  inequality  is  converted  to  an  equality  with  a (N^ +1^+3^ 

+bj->-N_) - dimensional  slack  variable  vector,  u. 

U = c.  I l } - 11  1 0 CA-  62) 

The  performance  measure  can  also  be  expressed  in  terms  of  the  x 

variable  vector.  Pot  the  augmented  variable  vector  x'  - [x  m] , 

Z = b'x"  + i-  x'c>x  (A-63) 

Compare  this  with  l.q.  (A-52) , alter  substituting  from  Pq.  (A-S8) 

J » l x'l'gl.  x + |k  . i:i  ’(7  + Fq  4 L’)li  x + m 
2 V V ' ihin--k  p < \ir  1 ]) 

» 

+ I l7'.  i.'l.'gP  1.  [1 '<7  + PIP.  l.k  . +(^:'(I+r')P  (A -64) 

? runH<  ]P  ]>+  1 p*  J p-k  min  v2  p1  * p v J 


■ 'wwmnwmmHiM^nni  . 
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The  following  matrices  are  required 


F.'tjh  . 

P P 0 


0 0 


Ep  (QDp+I)1 


(A-65) 


(A- 66) 


m j 


where 


5L  £ fli  1,  k . + F 1 

P 1 pnc  min  pJ 

Now  upon  application  of  the  Kuhn-Tucker  conditions,  the 


(A- 67) 


Lemke  complementary  problem  arises,  with  non-negative  multipliers 


v and  y (dual  variables) . 

r i r ip  r 1 

v Q -G'  x L 

= + 

u G 0 y -II 

_ L-  J L J L- 

rihe  large  matrix  and  vector  are 

~0  -CP 
M s „ 


(A-68) 


(A-69) 


(A- 70) 


The  partitioned  forms  of  these  matrices  are  shown  in  Eqs, 


(A- 71 ) and  (A-72) , with  the  dimensions  of  each  partition  indicated 
adjacent  to  the  matrix. 


9 iWW L 
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0 

0 
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0 
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0 

0 
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i 1;p  * R 


m 

-(E  l.k  . + P ) 

^ m-~k  min  nr 


(E  l.k  • •»  r ) 

c— K min  c 


| ^‘max  ^min^ik 


fS.l.k  ■ 4W.)-1  | s . 
d-k  In  in  cr  -d  min 


-(S  l.k  • +W  )+l  s 
s-k  mm  s'  — s max 


l.n  -II,  k . 

— k max  -k  mm 


-l.n  . +11.  k • 
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Nk 
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(A-71) 


(A- 7 2) 


APPENDIX  B 


CHARACTERISTIC  MANEUVER  FRAME  LENGTH  ESTIMATE 


The  characteristic  maneuver  was  defined  in  Section  4.2,  and  is 


shown  in  Figure  B-l. 


R1  R2  R3 


-maximum 

expected 

obstacle 


/ V 


V 

■m n A 

c c 


Figure  B-l  Characteristic  Maneuver 


Specified  for  the  maneuver  are 


k . - minimum  curvature 

nun 


k - maximum  curvature 
mux 

I!  - maximum  expected  obstacle  height. 

The  characteristic  frame  length,  Fc,  is  the  total  range  distance 
required  by  tne  maneuver  and  is  determined  after  computing  the 
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characteristic  range  interval,  A^.  'lice  slope  and  height  differential 

equations  arc  integrated  piece-wise  to  the  mid  range,  R,.  The  total 

frame  length  is  twice  the  value  of  It,. 

ARC  1 Ra  - 0 and  fl,  = A 
— 0 1 c 


For  Re  [Rft,Rj,  k(R) 


max  R 


S(R3  - /R  MDdr  - /n  -~ 
nf)  0 c 


_4 kmax  rr2,R  _ kmaxR 

rdr  " ~ a Hn  - 


Ac  1 2 J0 


R R k r 

h(R)  = /„  s(R)dr  = L 

K0  0 c 


\iax  { 3,R  _ kmaxR 
a ^ j n " — 


k A 

S(R1)  = 


and  v ,2 

v,  fu  ^ _ ^TlclX  C 

h(Up  - -g— 


ARC  2 


R,  - A and  R9  = 2a 
It  2 c 

rorRc[R1,l(2l,k-klnax 

S(R)  « SCR,)  * f|\Kaxdr  - ^ » WR-V 

*<*)  = 1’CRi ^ + T^a 


^ = Wc 

hf,V  = kmax^c 


ARC  5 


R,,  = 2 A and  K,  = 3 A . 
2 c 3 c 


0--2AJ 


rU«2.R,1,  U'O-W  * ——  <WW 


(11-11) 
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R (r-2A  ) 

S(R)  = S(R9)+/d  [k  „ + — c - (k  . -k  )ldr 

v 2 jR2  max  lq  '■min  max'2 

, R (k  - -k  J _ R 

’ Wl'c  * W^dzA  .*  -TZ--  »r-2Ac)2l2t 


■W‘k  * (R'24c>J  * UR-2‘C)2] 


(B-12) 


R x (k  . -k  ) 

h(R)  - hoy  . /R  (Vax'K  * tr-24c>l  * )2]idr 

<•  c 

■ Wk2  * + I (R-24c)Zl 


/min-’W)  [(R.j  ,5, 


(P-13) 


= (2kmax  + lWAc 


(B-14) 


htR3l  = <31W  * 5 W ?\ 


(B-X5) 


R3  = 2ac  311(1  Rc  = C3+X)ac’  where  nc  is  Co  be  determined. 

Tor  Re[R_,R  ] , k(R)  = k . 

1 3’  cJ  ' ' rain 


(B-16) 


S0»  * S(R3)  * /Rjlv,in<lr  - (2R„eui*kin>''ctk,Bin(R-5ac)  l8"17) 
1,M  - MR,)  * /„  U2Vu,  - I W*  * WI":VWr 


- (3k  +ik  . )a“  + (2k  +i  k . )a  (R-3a  ) 
max  6 min  c max  2 min'  c' 


+ ik  ■ (R-3A  )2 

2 inm  v c 


(B- 183 


"«IW*yDW  1 / UM  ir*r-i 
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SlRd  ‘ lZk»ax  * 

M\-)  - lOnJk^  * t4*VJncXi„V 

Now  the  boundary  conditions  can  be  applied  to  determine 


(B-19) 

(B-20) 


A and  n . 
c c 


S(RC)  = 0 


h(Rc)  = II 

I-rom  hqs . (.11-  JlJ)  and  (B- 21) 

k_ 
n 


(4  + 1) 


\iin 


Since  k . < 0,n  will  lie  a positive  number  when  k 

mm  c nux 

ilie  centra]  rattle  value  is 
n I7 , 

Rc  " ^3+T^c  - f 
Thus,  from  (H-23)  and  (B-24) 

F = A (5  - 4?— ) 

c c W 


(8-21) 

(B-22) 

(B- 23) 


k . 
nun 


(B-24) 


(B-25) 


All  that  remains  is  to  determine  A from  Rqs.  (B-20),  (B-22)  and 
fK-23) 

. 2 II 


(3+n  )k  +J/r(4+-Gn  +3n,“)k  ■ 

' c max  24  c c nun 

2411 

_____ 

48k  (1-  max)+k  • 

max  i 1 min 


mm 


2411 


4»Wl-£K£)*\,ln 

min 


(B-26) 


(B-27) 


?■»«;■»  - •-  • tv  .Sf* 


•A.-TM 


EXAMPLES: 


1*  Aircraft  Soft  Ride-  k = -in'S  r»’l  t, 

Kmjjj  id  ft  , k^^  = .00008,  H = 1000  ft 


4C  = S34  ft 


V'c  = lUc  “ 30 >800  ft 


\ - 31 


2.  Aircraft  Hard  Ride-  k = nnnn/i  v 

— Vin  ~ -.00004,  k^  = .00008,  H * 1000  ft 


*c  = 1440  ft 

rc  = 13ac  = 18,800  ft 

n.  = 7 
c 


3.  Missile  Soft  Ride;  k^  = -.000004,  = .000012,  H = 1000  ft 


Ac  = .324  ft 
Fc  = 17ic  = 54 *900 


n . - 11 


4.  Missile  Hard  Ride:  k 


kin  = '■ 00002 > ^ * .00006,  H = 1000  ft 


Ac  - 1444  ft 
ic  = 174c  = 24,600  ft 
*c  - 11 


5 • ^ j.5.1  lc  llatd  Rule  over  Smooth  Terrain  : 


“min 

Ac  = 1022  ft 


noon  ~ 

*kax  * -WUUO,  H = 500  ft 


]:c  = 17AC  = 17,400  ft 
nc  = 11 


_*T_  _ _ / V-/ < . 


AriT.NPix  c 

curva'iiiri:  ur.iAi  ioNsiiirs 

To  detenu i no  the  relationship  between  the  path  curvature  and 
the  normal  acceleration  (normal  to  the  path),  consider  height  to  be 
a function  of  range,  which  is  in  turn  a function  of  time. 

h = h(R(t) ) (C-l) 


'll io  curvature  is 

? 

, 4 d"n  d f dh  ^ 

k = 77  T nuTti 

Hut  1 >v  the  chain  mlc 


U>2) 


(C-3) 


(C-4) 


it 


bigur'-*  C-l  Velocities  and  Accelerations 


14!) 


-*+■ 
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R = R.  + r siny 


h = h - v cosy 
c c 


y ~ tan"1  ($-) 


Hie  slope  is 


dl'  „ 

m B tarY 

while  its  derivative  is 


d h 2 dY 
— y = sec  Y 4 


ilie  differential  of  ).q.  (OD)canhc  solved  for 


dy  _ 1 


- secy 


Thus,  the  relationship  between  the  curvature  and  radius  of 


curvature  is 


k - — sec  y 
r 

c 


(C-9) 

(C-10) 

(C- 11) 
CC-12) 
(C-13) 

(C-34) 

(C-15) 


APPENDIX  D 

DIRECT -SLOPE  SPLINE  FITTING  METHOD 


The  non-dimensional  range  variable  is 
o(x)  A (x-xi)/ai 

where  the  dimensional  range  increment  is 


ai  6 Vl  'xi 


Hie  ratio  of  successive  increments  is 


H,  L 


ai 


i+l 


0 


C 


and  the  change  in  dependent  variable  over  an  increment  is 

Yi  s -n 

The  cubic  spline  and  its  first  two  derivatives  can  then  be  written 

c 

y' (X)  = ± [Ai  + 2B.o  + 3C.02] 
y"(x)  = [2B-  4 6C.o] 

cl  • 

1 

Continuity  at  the  knot  where  ck+j  = 0 and  ck  = 1 requires 


2 3 

y(x)  = y.  4 A. a + B.o  + u-o 

' v J ' 1 X 1 1 


- = V.  4 A- 

+ R. 

1+1  ' 1 1 

1 

- Vl 

= — 1 

i*-l  a-.-, 

a-  ' 

i+l 

1 

2B.  , 

- 1+1 

1 

i+l  ~ 1 

1, 

c i+l 

ai 

lAi  4 2Bi  4 3CJ 


( 


(I 


Eqs.  (D-8)  and  (1)-P)  can  be  rewritten  as  a system  of  two  simul- 
t;uicous  equations : 


152 


■tt 


■Mtflutfia'tttiiRiijfiaiH  aW*. 't«  inni»nTWiitirr  awr 
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r n 

r — 

i i 

!b. 

Y.  -A. 

Y-  - Y' -a- 

1 1 

= 

l l 

= 

1 IX 

2 3 

* C 

HA-,,  -A. 
i i+l  l 

ai<y’i*r)r,i) 

CD-11) 


When  this  system  is  solved 


r — 

- 

;B. 

j l 

3 -1 

Y.  - y’.a. 
i 1 i l 

U'. 

L 

-2  1 

H-A- . , -A. 
i i+l  i 

CD-12) 


the  expressions  for  , C..  and  lh+1  can  nc  substituted  r-to  Eq. 
(0-10) 


or 


2,1i  i3Yi*i'ai*1c2>',i+iry,i+2}j-2C3yi-aic2y*i^yi+i; 

-6Yi+3ai(y'.4yl+1)]  (D-13) 

Y,  Y. 


y’.  +2(1+11-  )y* . , + ii.y ' . , = 3 (—  +11- 
1 i ^ iJ}  i+l  r i+2  vai  i ai+l 

Then  the  complete  set  of  equations  for  all  the  ur.knov::  can  be 

written 


CD-14) 


2(1+1^)  I!j  0 

1 2(1+11-,)  IL 


0 


y'2d 


1 


2(5+ll3)  1!3 


■ ly. 


y\ 


2tHV  M4 


2 (1 +W  7)  II  _ 
1 n 3 n-3 


2(1+H  .) 
n-2 


y' 


n-l  i 


is  equal  to 


i 

I 


\ 

I 
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3 -y\ 

3(E2+II2Z3) 

3<VW 


“n-2  ‘‘n-  2''n-l"IVi-2y  n ^ 


3 IX _7+'l  ..X 


(D-1S) 


where 


Y. 

E • A 1 

1 a. 

l 


(D- 16) 


Now  if  a procedure  similar  to  that  giver,  in  Section  ?.?,  is  followed 
to  hi -diagonal ire  the  above  matrix,  simple  recursive  equations  can 
be  derived:  1)  Divide  the  first  equation  by  the  first  coefficient. 

2)  Subtract  it  from  the  second  equation,  then  divide  the  resulting 
equation  by  the  first  non -zero  coefficient.  3)  Repeat  the  process 
of  step  2 for  each  successive  pair  of  equations,  until  the  result 
is  in  the  form 


1 Co 

L. 

0 

... 

| 

' L 

W» 

L 

0 1 

1 

C3 

\i 

i 

y'3 

W3 

!•••  o 

i 

1 

C4 

(! 

i 

...  1 

1 

y« 

4 

! W. 

i 4 i 

i 

* 

I 

| 

: 

= 

4 

i 

0 

1 

c , 
n-3 

0 

; 

0 

1 

c ? 
n-2 

. 

• 

• 

vv  •? 

n-2 

L 

0 

1 

i y'  . 

i J n~L 

_Vrcn-ly,n_ 

(D- 17) 


. • * J??  *■ 
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where 


Cj  - 0 


(D-18) 


W1  ' >’l 


(D-19) 


for  i=l,  2 n-2  the  forward  recursion  equations  are 


'i+l 


(D-20) 


^ i i : +1 ' i 


[HlTFc, 


(T>-21} 


finally,  tlie  backward  recursion  equations  yield, 


for  i = n-1 , n-2,  . . . , 2 


?'i  = WVi 


(D-22) 


All  data  necessary  to  compute  the  spline  or  its  derivatives  at 


any  point,  oe[C,l],  are  now  available: 


y(o)  •=  yi  + <t  (3-20)^.^-)^] 


+[(a-2y2-o3Jy'i+  (u3-o2)y’i+]]ai 


CD-23) 


(a)  - |2-Cl-o)[yi+1-yj]  ♦ |(l-4c.+3o2)y*i-C3o2-2o)y’i+1]  (D-24) 


6(1 -2c 


y"(o)  = ^i^[y.+1-y.]+_::[(3„-2)y-i  + (3a-l)y'i+1]  CD-25) 


D ...  +,,14.1] 


3 lyi+ryi]  ~~~2  ly'i-xM-i 


(11-20) 


Lin*  *131  "'i  1 J uij" 


% 


y 


v 


* 


¥ 
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Equal  Intervals 

It  is  interesting  to  note  the  special  form  of  Eq.  (D-15)  when 
the  spline  intervals  are  all  equal  (II  = 1) . 


4 1 0 ... 

y,2 

3Czi+r2)-y'i 

14  1 0 

y*3 

3(£2+E3-* 

0 14  10 

y> 

3(e3+i4) 

...01  41 

• 

• 

0 14  1 

: 

3^n-3+In-2^ 

...  0 1 4 

l'n-1 

_3^n-2+Vl^y,n 

CD-27) 


The  corresponding  recursion  equations  CD-20)  and  (D- 21)  become, 
for  .1=1,  2,  . , . , n-2: 

1 


c, . , = . 

i+i  'f'C- 


W. 


3(£i+}W'wi 


i+1 


T-Cf 


(D-28) 

CD-29) 


Ahlberg  [1,  pg  16J  shows  that  a second  order  difference 
equation  can  be  used  as  an  alternate  method  of  generating  the 
c^  and  Wi  coefficients  for  the  equal  interval  case. 

uJ  = 4d._1-d^_2  for  j=2,  3,  ...»  n-2 


d0  = 1 


d2  = 4 


(D-30) 

CD-31) 

CD-32) 


m turn  \uMtesa»*  a 


APPENDIX  E 


OFFSET- LOOP- POINT  REJECTION  METHOD 

When  the  instantaneous  radius  of  curvature  is  less  than  the 
offset  distance,  the  offset  curve  will  have  a loop  as  shown  in 
Figure  E-l. 

offset 


Figure  E-l  Offset  Loop 

Each  point  on  the  terrain  curve,  (R,T) , corresponds  to  a 

point  on  the  offset  curve,  (z,y).  Since  a smooth  clearance  curve 

is  desired,  the  portions  of  the  offset  curve  near  the  cusps  and 

the  crossover  point  should  not  be  used  for  points  on  the  clearance 

curve.  One  possible  metnod  for  selecting  clearance  curve  points 

near  a loop  is  to  establish  a rejection  range,  as  indicated  in  the 

figure  by  points  (z  ,y  ] and  (z  ,y  ).  These  points  could  be 
rl  rl  rZ  r2 

located  such  that  they  arc  some  prescribed  percentage  of  the  inter- 
vals [>2»7c]  311(1  f ZC*Z2J-  The  clearance  cur/e  could  then  be  fit 
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through  (zrl,Yri),  ^zr2,yr2^  311(1  otliet  Points  outside  the  rejection 
range.  The  proposed  rejection  procedure  is  outlined  below. 

Rejection  Procedure 

1.  Determine  if  an  offset  loop  is  present  either  by 


zi+i  < Z;L  when  Ri+1  > Rj,  or 


zl  ' 1 ' ^TT  < 0 

s +1 


for 


6 - n cosy 


(E-l) 

(E-Z) 


and 

s = tany  (E-3) 

'where  n is  the  offset  distance,  s is  the  terrain  slope,  k is  the 
curvature,  and  y is  the  path  angle. 

2.  Compute  the  cusp  points  using  a binary  chop  method. 

3.  Compute  the  crossover  point,  lying  between  the  two  cusps, 

by  a Newton- Raphson  two-dimensional  search,  by  moving  two  points 
together,  starting  from  the  cusp  points. 

4.  Select  the  appropriate  distances  between  the  cusp  points  and 
the  crossover  point  as  the  rejection  interval  limits  (30%  of  the 
distance  from  crossover  to  cusp  worked  reasonably  well). 


*> 
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APPENDIX  F 


SLANT  CLEARANCE  ESTIMATE  i 

i 

The  clearance  estimate  derived  here  is  a "local"  one,  in  that  i 

1 

i 

only  the  properties  of  the  terrain  curve  at  a single  point,  T,  are  j 

\ 

used.  The  radius  of  curvature,  r,  is  assumed  to  be  constant  in  the  ij 

immediate  vicinity  of  the  point.  Two  cases  are  considered:  those  j 

i 

of  positive  and  negative  terrain  curvature.  j 

Iri 

1 

F. 1 Positive  Curvature  I 


J 

r-n  / I 


Figure  F-l  Positive  Curvature  Clearance  Estimate 

The  point  C is  the  instantaneous  center  of  curvature  for  the 
arc,  and  S represents  the  estimated  point  that  has  a slant  clearance 
distance  of  n from  the  terrain  curve  (as  measured  along  the  normal) . 
The  vertical  clearance  distance  of  the  point  S is  C =(n+$).  From 
the  cosine  law  for  the  triangle  CST 

(r-n)2  = Cy2  + r2  - 2iCy  cosy  (F-l) 
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Tills  expression  can  be  solved  for  by  the  quadratic  formula. 


Cy  ■■=  r cosy  ±\y  (t  cosyj  - n(2r-n) 


(F-2) 


6 = n cosy 


(F-3) 


Cv  = ~ V(lf)2-nC2r-n) 


(F-4) 


This  estimate  should  only  be  used  if  r > n,  otherwise  the  normal 
offset  curve  has  a loop,  and  estimates  about  point  T are  unreliable. 
Therefore 


-n(2r-n)  < 0 


(F-5) 


--  >\/ (— '2-n(’r-pl 

n v v n ' 1 J 

when  the  radical  is  real.  So  there  aru  two  positive  roots,  with 
the  larger  one  corresponding  to  point  S shown  in  Figure  F-l.  The 


desired  root  is 


c -ri 

v n 


(~)2  -n(2r-n) 


F. 2 Negative  Curvature 

When  the  path  curvature  is  negative  the  radius  of  curvature 
also  has  a negative  sign 


1 3 

r = t-  see  y 

K 


(F-7) 


Thus,  with  r < 0,  and  = n+5 


Figure  F-2  Negative  Curvature  Clearance  Estimate 
Once  again,  the  cosine  law  for  triangle  CST  yields 


(n-r)Z  = Cv2  + r2  - 2Cv(-r)cos  (tt-y) 


(r-n)2  = Cy2  + r2  - 2Cv.rcosy 

This  equation  is  exactly  the  same  as  Eq.  (F-l)  so  the  solutions 


are  again 


cv  = IT  V O2  -nC2r'n) 


However,  by  convention,  this  time  r is  negative;  for  the  desired 
positive  root,  now  the  positive  sign  must  be  chosen. 


Since  now 


-n(2r-n)  > 0 


l^fl  <V C~)2  -n(Zr-n) 


while  the  negative  root  corresponds  to  S in  Figure  F-2, 
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Finally,  wc  can  solve  for  the  clearance  difference,  6,  in  a 
general  expression 

s = - n)  - sgn(r)  \/(^-)^-n{2T-n) 

= ' n)  ' sgn(r)\/(^-  - n)2-2r(n-e) 

In  general,  the  total  vertical  clearance  is 

Cv  = ~ ' sgn(r)\/(~-  - n)2  -2r(n-0) 


(F-12D 


(F-13) 


APPENDIX  G 


AIRCRAFT  SIMULATION 


This  Appendix  contains  the  equations  used  in  the  aircraft 
simulation.  Most  of  the  symbols  used  in  this  Appendix  are  not  used 
elsewhere  in  the  thesis,  therefore  the  symbols  are  defined  below. 


CL 

C, 


C. 


m 


L 

Ni 

ft 


V 


Total  drag  coefficient 
Trim  drag  coefficient 

Partial  derivative  of  the  drag  coefficient  with  respect  to 
various  "x"  variables 
Total  lift  coefficient 
Trim  lift  coefficient 

Partial  derivative  of  the  lift  coefficient  with  respect 
to  various  "x"  variables 
Total  moment  coefficient 
Trim  moment  coefficient 

Partial  derivative  of  the  moment  coefficient  with  respect 

to  various  "x"  variables 

Drag 


Thrust 


A t ”r  r-o  r t-  TTirtiUrtnl-  /->  f i ^ t fT*  ^ 

JU1  .1  Ui.v  invillVllt  VA  UK/i  LI  3, 


Lift 


Moment,  in  pitch,  about  the  aircraft  center  of  gravity 

Mach  number 

horizontal  range 

Sui face  reference  area 

Total  velocity  magnitude 
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at  1 Tfvr^ffiiaa 
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a Speed  of  sound 

F Distance  from  aircraft  center  of  gravity  to  thrust  line 

c Aircraft  reference  chord  length 
c.g.  Center  of  gravity  of  the  aircraft 
d Specific  drag  force 

i Specific  thrust  force 

g Specific  gravitational  force 

h Altitude 

k Path  curvature 

1 Specific  lift  force 

m Mass  of  aircraft 


Ditching  rate  with  respect  to  time  (positive-nose  up} 

Path  slope 

Component  of  veiocity  along  the  longitudinal  (x) 
stability  ;ixis 

Component  of  velocity  along  the  normal  (z)  stability  axis 
(pos i t i vc  downward ) 

Longitudinal  stability  coordinate 
State  variable  vector 

Normal  stability  coordinate  (positive  downward) 

Ind'catcs  a change  from  the  reference  condition 
Angle  of  attack 
Trim  angle  of  attack 
flight -path  angle 

Angle  of  x stability  axis  from  the  horizontal 


Command  signal  to  longitudinal  flight  controller 


Stabilator  (pitch  control  surface)  deflection  angle 
(positive,  trailing  edge  down) 

6Sa5  Stabilator  input  signal  from  stability  augmentation  system 

(SAS) 

p Atmospheric  density 

0 Pitch  angle 

e Thrust  alignment  angle 

G. 1 General  Aircraft  Equations  of  Motion 

The  seven-dimensional  state  variable  vector  is 

x_'  = [u,  w,  0,  q,  h,  «SAS,  6g]  (G-l) 

The  stability  axis  system  is  fixed  with  respect  to  the  aircraft 
as  shown  in  Figure  G-l.  It  coincides  with  the  trim,  or  steady- 
state,  wind  axis  system. 


longitudinal 


Figure  G-l  Stability  Axis  System 
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Normally  To  . „ for  Ulc  refcraicc 
with  respect  to  time  are 


condition. 


The  equations  of  motion 


VI 

0 

q 

li 


fx  + 'd  MW 

^2  + ^2  " ^ + q ^ 


q 


CAMV*"CM  + Mr 


U 51,1  Yo  ' w Yr 


6SAS  = CSAS  q - & 


'SAS 


^ ~ (s  (6SA8'6s  + 6C) 

where  C r .... 

S/VS  u Ls  I''  constants  and 

r a r 

x - m co*  c 

q 4 s si“  ^ 

M,  « j-1 

y 

„ A 

^x  ~ K0  sm  v0 


fcz  ~ «0  ccs  y0 

‘ S CAV\ 

d = CAvZC|l 


au!  1,10  acr(x]>iiamic  coefficients  are 


C * 

A ' 1,T 

C A 'bSc 
AM  " 71' 


CG-27 

(G-3) 

CG-4) 

(G-S) 

(G-6) 

(G-7) 

(G- 8) 

(G-S) 


CG-iO) 

(G-ll) 

(G-12) 

(G-13) 
(G- 14} 

(G-1SJ 

(G-l  6) 


(G-17) 


(Ci-18) 


\ 

J 


1 


l*  t.,.--  M#***~“  V, 


.-f| 

'an 
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C,  - C,  + C,  Aa  + C,  AM  + C,  A6 

L lO  La  % L6  S 

% ^ CD  + CDM  + + V4* 

o a ro  6 

C = C +C  Aa+CAM  + C A6  + ■*«-  (C  q+C  a) 
m m m nw  iu x s ZV_  ni  m* 

o a M <5  O q a 

These  additional  relationships  also  apply: 

2 2 2 

V = u + 

-1  w 
Aa  = tan  — 


a = a + Aa 
o 

v = 0 - a 
o O 

lor  this  problem  the  atmospheric  density,  pQ,  and  Mach  number 
are  assumed  constant  for  the  flight.  Note  also,  that  «0  is 
constant,  but  yQ  is  time  varying.  Furthermore, 

• uw  - wu 

“ ~ — i 

V 1 

Hie  time  differential  equations  can  be  converted  to  range 

dependence  by  multiplication  by  the  factor 

* , L dt  _ 1 
^ " dR 


R 


Thus 


t'  x 


The  path  slope  is 

b an 


= hr  = - 
R 


and  the  curvature  of  the  path  is 

h = ^ = ff  (r)2  + fit"  = fe 
dir  ft 


(G-19) 
(G-20) 
(G-21) 

CG-22) 
(G- 23) 
(G-24) 
CG- 25) 

(G-26) 

(G-Z/j 
(G-28) 

(G- 29) 

(G- 30) 


uni  -ift.  :i 
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G . 2 Normal izat ion 


The  variables  were  normalized  for  computation  according  to  the 
following  system: 

3 VU  = 1117.1  fps  (Mach  1 at  Sea  Level) 

1 DU  = 2000  ft 


1 TU  = j~  = J .79035  sec 


1 y\U  = = 623.9562096  fps2  = 19.3955924  Gs 


G.3  F-4C  Aircraft  Data  (from  Reference  12) 

Mach  .8  at  Sea  Level  (V  = 894  fps) 


a = 
o 

.3° 

6e  * . 3C 

bo 

r*  = 

.ore  , 

CD  = .018 

0 

CL  = 
a 

3.3  , 

CD  - .08 

a 

C 

in 

a 

= - .28 

V 

o. 

i) 

o 

C 

= - .04 

:L. 

0 

s 

.34  , 

r = n ^not 
'Dfi  given)  ’ 

°s 

C 

m6 

s 

= - .49 

in* 


C = -2.3 
in. 


5 . 25 


= 530  ft“ 

= 38,925  3b  = 1209.978  slug 


b ..  = 16.2  ft 

])i  lot 


c 

1 


=••  10.04  l't 


322,191  slug  ft' 


APPENDIX  H 


. -I 

' *i 


I 

s 


S 


i 


I 

i 


CONSTRAINT  VIOLATIONS  BETWEEN  SAMPLE  POINTS 

There  'ire  no  curvature  violations  between  cample  points,  because 
the  curvature  is  a linear  spline.  Neither  are  there  any  kink  viola-  V 

tions , since  the  kink  is  always  constant  over  each  sample  interval. 

However,  there  can  be  clearance  and  slope  constraint  violations „ 

The  maximum  clearance-constraint  violation  is  illustrated  in 
Figure  H-l. 


The  maximum  violation  occurs  for  a maximum  pull-up  path  directly 
above  a minimum  curvature  terrain  peak,  when  the  clearance  curve 
has  the  same  curvature  as  the  terrain  curve,  the  equations  for  the 
path  and  clearance  curve  over  the  interval  of  violation,  re[0,A], 
are 


l,(r)  • l.j  * s,r  * t C,iaxr2 


c(r)  = Cj  " th 


1 


• r + ic,.  r 


2 %in 
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(H-l) 
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Since  the  excess  clearance  is 


e(r)  = h(r)  - c(r) 


and 


hi  ■ ci 


Vi " ci*i 


Thus 


e(r)  - fs*  - d^r  - \ 0^^  ) 


min 


But  at  r=A,  Cqs.  (H-l)  and  (H- 2)  become 


h.^i  = h.  + s.A  i k A2 
l+l  i i 2 max 


h = h + dfA  + | k AZ 

mm 


The  difference  between  these  two  equations  is  divided  L 
to  yield 


- di  ■ • f iW  • \ J 

nun 


Then  from  I!qs.  (H-G)  and  (H-9) 


e(r)  = j (r2  - rA)  ) 

min 


The  extreme  value  of  e occurs  when 


0 " “ • \ (2r  - 4)  (k  -L,  ) 


or 


1 

7 


- - X « 0 

‘ilie  maximum  violation  is 


mm 


A 


e = - e (r*)  - X (V.  -kr  ) 
v v 1 X v max  1 - 1 

nun 


(H-3) 


(H-4) 

(H-5) 


(H-6) 


(H-7) 

01-8) 


QWJ) 


(H-10) 


mi) 


(11-12) 

(11-13) 


01-14) 


h 


Hi 
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If  there  are  slope  constraints  active  on  the  interval  of  violation, 
the  violation  will  have  an  even  smaller  bound  than  that  of  Eq.  (H-14) . 
In  this  case,  the  curvature  of  the  path  cannot  remain  at  a maximum 
value  over  the  entire  interval  without  violating  the  slope  constraint 
at  one  end  of  the  interval, 

A £>ound  op  the  maximum  slope -constraint  violation  can  be 
determined  from  the  geometry  of  Figure  H-2. 


Over  the  interval  of  violation,  the  curvature  goes  from  a 
maximum  to  a minimum  as  r goes  from  zero  to  a. 


Nnax  A ^max  ^min;  T 


The  path  slope  is  the  integral  or  this  equation. 


(H-15J 


s(r)  = s 


max 


^maxr 


1 

JE 


(k  -k  . ) r2 
v max  man7 


The  violation  is 


(H- 163 


V")  “ s^-rmax  = W '■  r2  01'17) 
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The  extreme  value  occurs  for 

as 


® ” ar  ^max  A ^max  ^min-*  r 


or 


r*  - 


k a 
max 

V — qc — ' 
max  min 


(H-18) 

(K-19) 


Thus , the  bound  on  the  maximum-slope  violation  is 

k 2 A 
max 


\ ~ 2(k — nr- j 

max  max  mm 


(H-20) 


Similarly,  a bound  or.  the  minimum-slope  violation  magnitude  can 


be  computed 


k . 2 A 
mm 


vmin  2 ^max'^min^ 


01-21) 
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